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《机 器 人 手册 第 1 卷 机 器 人 基础 》 共 分 两 篇 ,分 别 为 机 器 人 学 基础 和 机 器 人 结构 。 

机 器 人 学 基础 篇 介绍 了 在 模型 、 设 计 和 控制 机 器 人 系统 过 程 中 用 到 的 基本 原则 和 方法 ， 包 括 
运动 党、 动力 学、 机 构 与 驱动 、 传 感 与 估计 、 运 动 规划 、 动 作 控 制 、 力 控制 、 机 器 人 体系 结构 与 
程序 设计 、 机 絮 人 智能 推理 方法 。 这 些 主题 将 被 拓展 和 应 用 到 特殊 的 机 器 人 结构 和 系统 中 。 

机 器 人 结构 篇 既 闭 述 了 机 器 人 的 性 能 评价 与 设计 标准 、 模 型 识别 ， 又 介绍 了 运动 学 见 余 机 械 
臂 、 并 联机 器 人 、 有 具有 和 柔性 元 件 的 机 器 人 、 机 器 人 手 、 有 腿 机 器 人 、 轮 式 机 器 人 、 微 型 和 纳米 机 
器 人 的 结构 。 探 讨 了 在 实际 物理 实现 过 程 中 的 设计 、 模 型 、 运 动 计划 和 控制 等 问题 。 

本 手册 内 容 深 入 浅 出 ， 并 附 有 大 量 的 科研 实例 ， 便 于 自学 和 应 用 ， 可 作为 机 器 人 、 人 工 
智能 、 自 动 化 控制 以 及 计算 机 应 用 等 专业 科研 人 员 、 高 校 师 生 的 参考 用 书 ， 也 可 作为 相关 专 
业 本 科 生 或 研究 生 的 参考 教材 ， 还 可 供 机 器 人 业余 爱好 者 参考 。 
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详 从 F 


一 、 机 械 工程 高 速 发 展 


机 械 工程 是 以 自然 科学 和 技术 科学 为 理论 基础 ， 结 合 在 生产 实践 中 积累 的 技术 经 验 ， 研 究 和 解决 机 械 产品 
开发 、 设 计 、 制 造 、 安 装 、 运 用、 修理 及 再 制造 等 方面 的 全 部 理论 和 实际 应 用 的 学 科 。 机 械 工程 的 学 科 内 容 包 
括 : 机 械 工程 基础 理论 研究 ， 机 械 产品 开发 、 设 计 ， 机 械 产品 的 制造 、 装 备 、 检 验 ， 机 械 产 品 的 应 用 与 维护 ， 
机 械 制 造 企业 的 经 营 和 管理 ， 机 械 产 品 的 绿色 生命 周期 等 问题 及 技术 措施 。 机 械 工 程 先进 技术 涉及 设计 、 制 
造 、 应 用 、 管 理 等 相关 环节 的 机 械 、 电 子 、 信 息 、 材 料 、 能 源 和 管理 科学 等 领域 的 先进 技术 。 

20 世纪 后 期 ， 特 别 是 进入 21 HA, 计算机、 信息 技术 在 机 械 工 程 领域 的 广泛 、 深 入 应 用 ,使 机 械 工 程 技 
术 高 速 发 展 。 机 械 工程 技术 由 线性 到 非 线性 、 由 静态 到 动态 、 由 二 维 到 三 维 的 研究 发 展 ， 为 现代 机 械 设计 方法 
的 研究 、 应 用 葛 定 了 工程 理论 基础 ; 虚拟 技术 、 创 新 设计 、 绿 色 设计 、 并 行 工程 等 ,为 现代 机 械 设计 提供 了 技 
术 基 础 ; 机 床 数控 技术 、 工 业 机 器 人 、 和 柔性 制造 技术 、 传 感 技术 、 集 成 制造 技术 、 自 动 检 测 及 信号 识别 技术 
等 ， 为 机 械 制 造 工 艺 自动 化 提供 了 支撑 技术 ; ERP (企业 资源 计划 ) MES (制造 管理 信息 系统 ) CIMS (it 
算 机 集成 制造 系统 ) 等 ， 为 机 械 制 造 企 业 的 经 营 和 管理 提供 了 现代 化 的 支撑 平台 ; PLM (产品 全 生命 周期 管 
理 ) IWM (废物 管理 一 体 化 ) EMS (环境 管理 体系 ) 等 理念 、 技 术 的 发 展 ， 已 成 为 机 械 工程 先进 技术 的 重 
要 组 成 部 分 。 

机 械 工程 先进 技术 是 实现 工业 技术 现代 化 重要 的 技术 支撑 之 一 。 但 是 ， 机 械 工程 先进 技术 的 发 展 要 受到 自 
然 条 件 、 经 济 条 件 、 社 会 条 件 、 技 术 基 础 等 的 限制 ， 我 国 作为 发 展 中 国家 ， 在 机 械 工程 先进 技术 方面 同 工 业 发 
达 国 家 还 有 很 大 差距 。 为 了 加 快 我 国 机 械 工程 先进 技术 的 发 展 进 程 ， 通 过 各 种 方式 引进 外 国 机 械 工程 先进 技 
术 ， 是 一 条 切实 可 行 的 发 展 之 路 。 

二 、 图 书 交 流传 播 知识 

图 书 资料 是 一 种 传统 、 永 恒 、 有 效 的 学 术 、 技 术 交 流 方式 。 早 在 20 世纪 初期 ， 我 国清 代 学 者 严复 就 翻译 
了 英国 学 者 赫 悄 黎 所 著 的 《天 演 论 》， 其 后 学 者 周 建 人 翻译 了 英国 学 者 达尔 文 所 著 的 《物种 起 源 》， 对 我 国 自 
然 科 学 的 发 展 起 到 了 很 大 的 推动 作用 。 
图 书 是 一 种 信息 载体 ， 图 书 是 一 个 海洋 ， 虽 然 现 在 已 有 网 络 通信 、 计 算 机 等 信息 传输 和 储存 手段 ， 但 图 书 
仍 将 以 严谨 性 、 系 统 性 、 广 泛 性 、 适 应 性 、 持 久 性 和 经 济 性 而 长 期 存在 。 纸 质 图 书 有 更 好 的 阅读 优势 ， 可 满足 
不 同 层次 读者 的 阅读 习惯 ， 同 时 它 具 有 长 期 的 参考 价值 和 收藏 价值 。 

近年 来 ， 国 际 间 的 交流 与 合作 对 机 械 工程 技术 领域 的 发 展 、 技 术 进 步 及 重大 关键 技术 的 突破 起 到 了 积极 的 
促进 作用 ， 对 机 械 工程 技术 领域 科技 人 员 及 时 了 解 国外 相关 技术 领域 的 最 新 发 展 状况 、 取 得 的 最 新 成 果 及 应 用 
情况 等 ， 发 挥 了 积极 作用 。 

机 械 工 业 出 版 社 希 望 通过 引进 、 翻 译 国 外 机 械 工程 技术 领域 的 先进 技术 图 书 ， 传 播 国 外 机 械 工程 领域 的 先 
进 技术 ， 推 动 国内 学 者 和 技术 人 员 对 国外 机 械 工程 先进 技术 的 引进 、 消 化 、 吸 收 和 创新 发 展 ， 从 而 提升 我 国 机 
械 工程 技术 的 自主 创新 能 力 ， 提 高 我 国 装备 制造 业 的 技术 水 平 ， 加 速 实 现 我 国 工业 的 现代 化 。 
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为 真正 实现 翻译 国外 机 械 工程 技术 领域 先进 技术 图 书 、 推 动 我 国 机 械 工程 技术 发 展 的 战略 目标 ， 机 械 工业 
出 版 社 将 认真 执行 : 

(1) 精 挑 细 选 ”坚持 从 机 械 工程 技术 比较 发 达 的 国家 、 国 外 优秀 出 版 社 引进 优秀 技术 图 书 ， 组 成 一 套 
《国际 机 械 工程 先进 技术 译 从 》。 本 套 译 从 将 涵盖 机 械 工程 的 基础 理论 研究 ， 产 品 开发 、 设 计 、 制 造 、 运 用 、 
维修 、 再 制造 和 资源 、 环 人保、 信息、 管理 等 相关 学 科 。 
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(2) 精 雕 细 刻 ”本 套 从 书 的 选 书 、 翻 译 工作 均 由 国内 相关 专业 的 专家 、 教 授 、 工 程 技 术 人 员 把 关 ， 以 充 


分 保证 图 书 内 容 的 先进 性 、 适 用 性 和 翻译 质量 。 内 容 翻 译 力争 达到 信 、 达 、 雅 ， 真正 实现 传播 国 
进 技术 ， 服 务 于 国内 机 械 工程 技术 的 发 展 。 
(3) 精益 求 精 ”本 套 丛 书 作为 我 社 的 精品 重点 书 ， 将 统一 封面 装帧 设计 ， 在 版 式 编排 、 内 


印 制 等 方面 追求 高 质量 ， 把 “精品 ”体现 到 书 的 整体 中 去 ， 力 求 为 读者 奉献 一 套 高 品质 的 《 国 
进 技术 译 从 》。 


四 、 囊 心 感谢 不 音 指 教 
首先 要 感谢 广大 积极 热心 支持 出 版 《国际 机 械 工程 先进 技术 译 从 》 的 专家 学 者 ， 积 极 推荐 


要 感谢 从 事 图 书 版 权 贸 易 的 工作 人 员 的 辛勤 工作 。 


本 套 丛 书 希望 能 对 广大 读者 的 工作 提供 切实 的 帮助 ， 欢 迎 广大 读者 不 音 指 教 ， 提 出 宝贵 意见 
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国外 相关 优秀 


图 书 ， 仔 细 评 审 外 文 原版 书 ， 推 荐 翻译 的 知名 专家 ; 特别 要 感谢 承担 翻译 工作 的 译 者 所 付出 的 辛勤 劳动 ; 同时 


和 建议 。 


机 械 工 业 出 版 社 《 国 际 机 械 工程 先进 技术 译 从 》 编 委 会 


作者 序 一 


我 对 机 器 人 学 的 首次 了 解 是 源 自 1964 年 的 一 个 电话 。 打 电话 的 人 是 
Fred Terman， 世 界 著名 的 《无 线 电 工程 师 手 册 》 的 作者 ， 当 时 任 斯 坦 福 
大 学 教务 长 。Terman 博士 告诉 我 计算 机 科学 教授 John McCarthy 刚 获得 一 
大 笔 研究 经 费 ， 其 中 的 一 部 分 将 用 于 开发 计算 机 控制 的 机 械 怖 。 有 人 向 
Terman 建议 ， 如 果 以 数学 为 方向 的 McCarthy 教授 和 机 械 设 计 师 联手 ， 这 
将 会 是 很 聪明 的 做 法 。 由 于 我 是 斯 坦 福 教员 中 唯一 有 机 械 设计 专长 的 人 ， 
Terman 打算 给 我 打 个 电话 ， 尽 管 我 们 从 未 谋面 ， 而且 我 还 是 个 刚刚 研究 
生 毕 业 、 在 斯 坦 福 只 工作 了 两 年 的 年 轻 助理 教授 。 

Terman 博士 的 电话 使 我 与 John McCarthy 和 他 创建 的 斯 坦 福 人 工 智 能 


实验 室 (SAIL) 有 了 紧密 的 联系 。 机 器 人 成 了 我 整个 学 术 生 涯 的 支柱 ， Bernard Roth 
直到 今天 ， 我 一 直 保持 着 对 这 一 主题 的 教学 与 研究 兴趣 。 美国 斯 坦 福 大 学 机 械 工程 教授 


机 器 人 控制 的 近代 历史 要 追溯 到 20 世纪 40 年 代 后 期 ， 当 时 人 向 服 控 
制 的 机 械 臂 被 开发 出 来 ， 它 与 主 从 方式 的 机 械 臂 连接 起 来 被 用 于 处 理 核 物质 ， 从 而 保护 相关 人 员 。 这 一 领域 的 
发 展 一 直 延 续 到 现在 。 然 而 在 20 世纪 60 年 代 初 期 ， 还 很 少 有 关于 机 器 人 学 的 学 术 活 动 和 商业 活动 。 首 个 学 术 
活动 是 1961 年 麻 省 理工 学 院 H. A. Ernst 的 论文 。 他 用 装 有 触觉 传感器 的 从 动机 械 避 在 计算 机 控制 下 工作 。 他 
的 研究 思想 就 是 利用 触觉 传感器 中 的 信息 来 引导 机 械 臂 运动 。 

之 后 斯 坦 福 人 工 智能 实验 室 随 之 开展 了 相关 项 目 ， 麻 省 理工 学 院 Marvin Minsky 教授 也 启动 了 类 似 的 项 目 ， 
这 些 研 究 在 当时 是 在 机 器 人 学 领域 为 数 不 多 的 学 术 置 险 。 这 些 尝试 中 的 少数 是 在 商业 机 械 臂 方面 ， 大 部 分 与 汽 
车 工业 生产 相 联系 。 在 美国 ， 在 汽车 工业 中 对 两 种 不 同 的 机 械 民 设计 进行 了 实验 : 其 中 一 种 来 自 AMF 公司 ， 
另 一 种 来 自 Unimation 公司 。 

另外 还 有 一 些 制 造成 手 、 腿 和 和 臂 部 假肢 的 机 械 装 置 ， 不 久之 后 ,为 了 提高 人 的 能 力 还 出 现 了 外 骨骼 装置 。 
那 时 还 没有 微 处 理 器 ， 所 以 这 些 装 置 既 不 受 计算 机 控制 ， 也 不 受 远 程 的 所 谓 微机 所 遥控 ， 更 不 用 说 大 型 计算 机 
控制 了 。 

最 初 ， 计 算 机 科学 领域 中 的 一 些 人 认为 计算 机 已 足够 强大 ， 可 以 控制 任何 机 械 设备 ， 并 使 其 完美 执行 。 但 
我 们 很 快 发 现 并 非 如 此 。 我 们 分 两 条 路 线 进行 。 其 一 是 为 斯 坦 福 人 工 智能 实验 室 (SAIL) 开发 特殊 设备 装置 ， 
以 保证 刚刚 起 步 的 机 器 人 团队 开展 实验 达到 硬件 证 明 与 概 您 验证 系统 。 另 一 条 路 线 或 多 或 少 与 斯 坦 福 人 工 智 能 
实验 室 的 工作 相关 ， 是 发 展 机 器 人 的 基础 机 械 科学 。 我 有 一 种 强烈 的 感觉 ， 可 能 会 发 展 出 一 项 有 意义 的 科学 。 
我 们 最 好 从 基本 概念 的 方面 思考 ， 而 不 是 专门 集中 在 特定 的 设备 上 面 。 

幸运 的 是 ， 两 种 路 线 竞 然 相互 间 非 常 和 谐 融 治 。 更 重要 的 是 ,研究 者 们 对 这 一 领域 的 研究 很 感 兴趣 。 硬 件 
开发 为 更 多 的 基本 概念 提供 了 有 具体 的 例证 ,研究 者 们 能 够 同时 开发 硬件 和 理论 。 
起 初 ， 为 了 尽快 开始 研究 ， 我 们 购买 了 一 只 机 械 避 。 在 洛杉矶 的 Rancho Los Amigos 医院 有 人 在 销售 一 种 
开关 控制 型 电动 机 了 驱动 的 外 骨骼 机 械 辟 ， 用 来 帮助 那些 怖 部 失去 肌肉 的 患者 。 我 们 购买 了 一 台 ， 把 它 连 接 在 
PDP-6 型 分 时 计算 机 上 。 这 大 ,设备 被 命名 为 “奶油 手指 ”， 它 是 我 们 的 第 一 个 实验 机 器 人 。 一 些 电 影展 示 的 视 
觉 反 馈 控 制 、 扒 探 任务 和 避 障 都 是 由 这 人 台 机 器 人 作为 明星 演员 完成 的 。 

第 一 个 由 我 们 自主 设计 的 操纵 器 被 简单 认为 是 “水 压 臂 ” 。 正 如 它 的 名 字 所 指 ， 它 是 由 水 力 驱动 的 。 要 建 
立 一 个 非常 快 的 手臂 ， 我 们 设计 了 特殊 的 旋转 驱动 器 ， 这 个 手臂 工作 得 非常 好 。 它 成 为 了 最 早 测 试 机 器 人 和 手 丑 
的 动态 分 析 和 时 间 最 优化 控制 的 实验 平台 。 然 而 ， 当 时 普遍 来 说 ， 计 算 、 规 划 和 传 感 性 能 都 很 有 限 ， 由 于 设计 
速度 比 要 求 速度 快 得 非常 多 ， 使 得 这 项 技术 的 应 用 很 受 限 制 。 

我 们 尝试 去 开发 一 个 真正 的 数字 化 手 怖 。 从 而 产生 了 一 个 蛇 形 结构 ， 取 名 为 Om (挪威 语 中 的 蛇 ) Orm 
有 若干 节 ， 每 节 有 膨胀 的 气动 驱动 器 阵列 ， 它 们 要 么 完全 伸展 ， 要 么 完全 收缩 。 基 本 思想 是 ; 虽然 在 工作 空间 
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中 Orm 仅 可 达到 有 限 数量 的 位 置 ， 但 是 如 果 达 到 的 位 置 有 很 多 ， 那 么 这 也 是 足够 的 。 一 个 经 过 概念 验证 的 小 
型 原型 Orm 被 开发 出 来 ， 然 而 我 们 发 现 这 种 类 型 的 手臂 不 能 用 于 斯 坦 福 人 工 智 能 实验 室 团队 。 

我 们 实验 室 第 一 个 真正 具有 功能 的 手臂 是 由 当时 的 研究 生 Victor Scheinman 设计 的 ， 它 就 是 非常 成 功 的 
“斯 坦 福 手 臂 ” 。 有 十 几 个 这 种 手臂 作 为 研究 工具 用 于 不 同 的 大 学 、 政 府 和 工业 实验 室 。 它 有 六 个 独立 驱动 关 
节 ， 均 由 计算 机 控制 的 直流 伺服 电动 机 驱动 。 其 中 一 个 关节 是 棱柱 的 ， 另 外 五 个 是 旋转 的 。 

鉴于 “奶油 手指 ”的 几何 学 需要 逆 运 动 学 的 迭代 解 ， 因 此 选择 “斯 坦 福 手 展 ” 的 几何 构 型 ， 即 可 以 通过 
编程 获得 其 逆 运 动 学 的 迭代 解 ， 应 用 起 来 简单 而 高 效 。 而 且 ， 这 个 机 械 设 计 是 特别 制作 的 ， 以 兼容 分 时 计算 机 
控制 固有 的 局 限 性 。 不 同 的 末端 执行 器 被 连接 到 机 械 避 末端 作为 手 。 在 我 们 的 版 本 中 ， 手 被 做 成 钳 夹 的 形式 ， 
还 有 两 只 滑动 手指 ， 两 只 手指 由 一 台 伺服 驱动 器 驱动 ， 因 此 ， 手 臂 的 实际 自由 度数 目 有 7 个 。 它 也 有 一 个 特别 
设计 的 六 轴 腕 部 力 传感器 。Victor Scheinman 继续 开发 了 其 他 重要 的 机 器 人 : 首先 是 一 个 有 六 个 旋转 关节 的 小 
型 仿 人 手臂 。 最 初 设 计 是 由 麻 省 理工 学 院 人 工 智 能 实验 室 Marvin Minsky 资助 的 。Victor Scheinman 建立 了 
Vicarm 公司 ， 这 是 一 家 小 公司 ， 为 其 他 实验 室 制 造 了 这 个 手臂 和 “斯 坦 福 手 臂 ”。Vicarm 后 来 成 为 了 Unimation 
公司 的 西海 岸 分 部 ， 在 那里 ， 通 过 Unimation 公司 在 通用 电机 公司 资助 下 他 设计 了 PUMA FUR. JE, 
Scheinman 为 Automatix 公司 开发 了 全 新 的 Robot World 多 机 器 人 系统 。 在 Scheinman 离开 Unimation 后 ， 他 的 同 
事 Brian Carlisle 和 Bruce Shimano 重组 了 Unimation 公司 的 西海 岸 分 部 Adept 公司 ， 该 公司 现在 是 美国 最 大 
的 装配 机 器 人 制造 商 。 

很 快 ， 精 密 机 械 和 电子 设计 、 优 化 的 软件 ， 以 及 完整 系统 集成 的 现代 化 趋势 成 为 常态 。 到 现在 ， 这 些 结合 
是 最 高 级 机 器 人 装置 的 标志 。 这 是 在 “机 械 电子 ”( 又 译 “ 机 电 一 体 化 ”或 “电子 机 械 ”，mechatronic) d 
的 基本 概念 。“ 机 械 电 子 ” 这 个 词 发 源 于 日 本 ， 它 代表 机 械 和 电子 两 个 词 的 串联 。 依 赖 于 计算 的 机 械 电 子 ， 
如 我 们 今天 所 知 的， 是 机 器 人 固有 技术 的 实质 。 

随 着 机 器 人 技术 在 全 世界 的 发 展 ， 很 多 人 开始 在 与 机 器 人 相关 的 领域 工作 ， 一 些 特有 的 附属 专业 得 到 了 发 
展 。 首 先 最 大 的 分 化 是 进行 机 械 避 工作 的 人 和 视觉 系统 工作 的 人 。 早 期 ， 视 觉 系统 在 给 出 机 器 人 周围 环境 的 信 
息 方面 看 起 来 比 其 他 方法 更 有 前 途 。 

视觉 系统 是 通过 摄像 机 来 捕获 周围 物体 的 图 片 ， 然 后 使 用 计算 机 算法 对 图 像 进 行 分 析 ， 从 而 推断 出 物体 的 
位 置 、 方 位 和 其 他 特性 。 图 像 系统 最 初 的 成 功 在 于 解决 定位 障碍 物 问 题 、 解 决 物体 操作 问题 和 读 取 装配 工程 
图 。 人 们 感到 视觉 用 于 与 工厂 自动 化 和 太空 探索 有 关 的 机 器 人 系统 中 具有 很 大 潜力 。 这 致使 人 们 开始 研究 可 以 
通过 视觉 系统 识别 机 器 零件 (特别 对 于 部 分 封闭 的 零件 ， 发 生 在 所 谓 的 “ 拾 箱 ” 问 题 中 ) 和 形状 不 规则 的 碎 
石 的 软件 。 
在 “看 ”和 移动 物体 的 能 力 被 建立 以 后 ， 下 一 个 合理 的 需要 就 是 让 机 器 人 做 一 系列 事件 的 规划 、 去 完成 
一 项 复杂 的 任务 。 这 使 得 规划 的 发 展 成 为 机 器 人 技术 非常 重要 的 分 支 。 在 固定 的 环境 中 制定 固定 的 计划 相对 来 
说 是 很 直接 的 。 然 而 ， 在 机 器 人 技术 中 ， 面 临 的 挑战 之 一 就 是 ， 由 于 误差 或 者 未 计划 的 事件 ， 环 境 发 生 了 未 预 
料 到 的 变化 ， 此 时 ， 机 器 人 会 发 现 环 境 的 变化 并 且 修 改 自 身 的 行动 。 在 此 领域 的 一 些 里 程 碑 事件 是 通过 使 用 一 
台 叫 做 Shakey 的 车 辆 来 开展 的 ， 开 始 于 1966 年 ， 由 斯 坦 福 研究 所 (现在 称 为 SRI) 的 Charlie Rosen 小 组 开发 。 
Shakey 有 一 人 台 摄 像 机 、 上 距离 探测 器 、 砸 撞 传 感 器 ， 通 过 无 线 电 和 视频 连接 到 DEC PDP-10 和 PDP-15 计算 机 上 。 

Shakey 是 第 一 台 可 以 思考 自己 行动 的 移动 机 器 人 。 它 利用 程序 获得 独立 感知 、 周 围 环境 模仿 和 产生 动作 的 
能 力 。 低 级 别 的 操作 程序 负责 简单 的 移动 、 转 动 和 路 径 规划 。 中 级 别 的 操作 程序 包含 若干 个 低级 别 程序 ， 可 以 
完成 更 复杂 的 任务 。 最 高 级 的 操作 程序 能 够 制定 和 执行 计划 来 实现 用 户 提出 的 高 级 目标 。 

视觉 系统 对 于 导航 、 物 体 定 位 和 确定 它们 之 间 的 相对 位 置 与 方位 非常 有 用 。 然 而 ， 当 在 具有 环境 约束 力 的 
地 方 ， 对 于 装配 零件 或 者 与 其 他 机 器 人 一 起 工作 ， 只 有 视觉 系统 通常 是 不 够 的 。 因 而 产生 了 一 种 需求 : 对 环境 
施加 到 机 器 人 上 的 力 和 力矩 进行 测量 ， 并 利用 测量 结果 来 控制 机 器 人 的 行动 。 多 年 以 来 ， 力 控制 操作 成 为 了 斯 
坦 福 人 工 智能 实验 室 和 遍布 世界 的 其 他 几 个 实验 室 的 主要 研究 课题 之 一 。 力 控制 在 工业 实践 中 的 使 用 始终 落后 
于 该 领域 的 研究 发 展 。 这 是 由 于 尽管 高 级 的 力 控制 系统 对 于 通用 的 操作 问题 非常 有 效 ， 但 限制 非常 苛刻 的 工业 
环境 的 特殊 问题 经 常 只 能 在 有 限 的 力 控制 甚至 没有 力 控 制 时 解决 。 

在 20 世纪 70 年代， 行走 机 器 、 机 械 手 、 自 动 汽车 、 多 传感器 信号 融合 和 恶劣 环境 设计 等 专门 领域 开始 快 
速 发 展 。 今 天 有 大 量 的 、 不 同 的 以 机 器 人 为 主题 的 专门 性 研究 ， 其 中 有 一 些 是 经 典 的 工程 学 科 领 域 ， 如 运动 
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学 、 动 力学 、 控 制 学 、 机 器 设计 、 拓 扑 学 和 轨迹 规划 。 每 一 个 学 科 在 研究 机 器 人 技术 之 前 都 已 经 走 过 了 一 段 漫 
长 的 路 程 ， 而 为 了 发 展 机 器 人 系统 和 应 用 ， 每 一 个 学 科 已 成 为 深入 研究 机 器 人 技术 的 一 个 方面 。 

在 理论 正在 发 展 的 同一 时 间 里 ， 工 业 机 器 人 ， 尽 管 稍微 有 些 分 离 ， 也 有 了 并 行 的 发 展 。 在 日 本 和 欧洲 ， 商 
业 开 发 强劲 ， 美 国 也 相继 发 展 。 相 关 的 工业 协会 纷纷 成 立 〈 日 本 机 器 人 协会 在 1971 年 3 月 成 立 ， XE Le 
人 工业 协会 (RIA) 在 1974 年 成 立 ) ， 定 期 举行 协会 展览 会 ， 并 召开 了 应 用 导向 的 技术 会 议 。 其 中 最 重要 的 有 
工业 机 器 人 国际 研讨 会 (ISIR) 、 工 业 机 器 人 技术 会 议 (现在 称 为 工业 机 器 人 技术 国际 会 议 (ICIRT) ) UREA 
际 机 器 人 和 视觉 展览 与 会 议 (这 是 由 RIA. 每 年 举办 的 贸易 展览 会 ) 。 

第 一 个 定期 的 系列 会 议 在 1973 年 召开 。 它 强调 机 器 人 技术 的 各 个 研究 方面 ， 而 不 仅仅 是 工业 上 的 。 它 由 
在 意大利 鸟 迪 内 的 机 械 科技 国际 中 心 (CISM) 和 机 械 与 机 器 理论 国际 联合 会 (IFToMM) 共同 赞助 (尽管 
IFToMM 仍 在 使 用 ,但 是 意义 已 经 变 为 机 械 与 机 器 科学 促进 国际 联合 会 )。 该 会 议 的 名 称 是 机 器 人 与 机 械 辟 的 
理论 与 实践 大 会 (RoManSy) ， 明 显 特征 是 强调 机 械 科学 和 来 自 东 欧 、 西 欧 ， 还 有 北美 和 日 本 的 科研 人 员 们 的 
AMAT. DERM, 会议 现 在 仍然 每 半年 举行 一 次 。 在 我 个 人 的 笔记 里 ， 就 是 在 RoManSy 会 议 中 ， 我 首次 
遇 到 了 这 本 手册 的 各 位 编辑 : 1978 年 遇 到 了 Khatib 博士 ，1984 438 5| T Siciliano 博士 。 他 们 当时 都 是 学 生 : 
Bruno Siciliano 攻读 他 的 博士 学 位 已 经 差不多 一 年 了 ，Oussama Khatib 那 时 刚刚 完成 了 他 的 博士 学 位 研究 。 两 个 
事件 ， 都 让 人 产生 一 见 钟情 的 感觉 ! 

众多 其 他 新 的 会 议和 研讨 会 迅速 加 入 到 RoManSy 里 面 。 如 今 ， 每 年 有 大 量 机 器 人 研究 导向 的 会 议 在 许多 
国家 举行 。 当 前 ， 最 大 型 的 会 议 是 一 般 吸引 了 超过 1000 位 参 会 者 的 IEEE 机 器 人 与 自动 化 国际 会 议 (ICRA), 

在 20 世纪 80 年 代 初期 ，Richard Paul 撰写 了 美国 第 一 本 真正 关于 机 器 人 操作 的 教材 《机 器 人 操作 一 一 数 
学 、 编 程 与 控制 》 出 版 社 (Richard P. Paul，MIT，1981) 。 它 把 经 典 力学 学 科 的 理论 应 用 到 机 器 人 领域 。 另 外 ， 
书 中 有 一 些 主题 是 从 他 在 斯 坦 福 人 工 智 能 实验 室 的 论文 研究 中 直接 发 展 而 来 (在 书 里 面 ， 许 多 例子 基于 
Scheinman 的 “斯 坦 福 手臂 ”。) Paul 的 书 是 美国 的 一 个 里 程 碑 事件 ， 它 为 将 来 一 些 有 影响 力 的 教材 开创 了 一 
个 模式 ， 还 鼓励 众多 的 大 学 与 学 院 开 设 专门 的 机 器 人 课程 。 

差不多 与 此 同时 ， 一 些 新 的 期 刊 创刊 ， 这 些 期 刊 主要 发 表 机 器 人 相关 领域 的 论文 。 在 1982 年 的 春天 ,《 机 
器 人 研究 国际 期 刊 》 创 刊 ， 三 年 之 后 , (IEEE 机 器 人 与 自动 化 期 刊 》( 现 在 的 《IEEE 机 器 人 学 报 》) 创刊 。 

随 着 微 处 理 器 的 普及 ， 关 于 什么 是 或 什么 不 是 机 器 人 的 问题 更 加 凸显 出 来 。 在 我 的 脑海 里 ， 这 个 争论 从 来 
没有 被 很 好 地 解决 过 。 我 认为 永远 不 会 有 一 个 大 家 都 普遍 同意 的 定义 。 当 然 ， 存 在 着 科幻 小 说 中 各 种 各 样 的 外 
太空 生物 和 戏院 、 文 学 以 及 电影 中 的 机 器 人 。 早 在 工业 革命 之 前 ， 就 有 过 想象 中 的 类 似 机 器 人 生物 的 例子 ， 但 
实际 的 机 器 人 又 会 是 什么 样 的 呢 ? 我 认为 关于 机 器 人 的 定义 实质 上 是 一 个 随 着 科技 进步 而 不 断 改变 其 本 体 特征 
的 移动 部 。 例 如 当 船 上 的 陀螺 仪 自动 罗 副 第 一 次 被 开发 出 来 时 就 被 认为 是 一 个 机 器 人 。 现 在 ， 当 我 们 罗列 在 我 
们 世界 中 的 机 器 人 的 时 候 ， 总 是 无 法 完全 赛 括 所 有 的 机 器 人 。 机 器 人 的 定义 已 经 被 降级 了 ， 现 在 机 器 人 被 看 做 
是 一 种 自动 控制 装置 。 

对 于 很 多 人 来 说 ， 机 器 人 包含 着 多 功能 的 概念 ， 机 器 人 即 意味 着 在 设计 和 制造 时 就 具备 了 容易 适应 或 者 可 
被 重新 编程 以 完成 不 同 任务 的 能 力 。 在 理论 上 ， 这 种 想法 应 该 可 以 实现 的 ， 但 在 实际 中 ， 却 是 大 多 数 的 机 器 人 
装置 只 能 在 非常 有 限 的 领域 里 实现 多 功能 。 人 们 很 快 发 现 ， 在 工业 中 一 般 而 言 ， 一 台 具 有 专门 用 途 的 机 器 要 比 
一 合 具 有 广泛 用 途 的 机 器 表现 好 得 多 。 而 且 在 制造 加 工时 ， 当 产品 的 产量 足够 高 的 时 候 ， 一 侣 具有 专门 用 途 的 
机 器 要 比 一 台 具 有 广泛 用 途 的 机 器 花费 少 。 因 此 ， 人 们 开发 出 专业 机 器 人 用 于 喷漆 、 锦 接 、 零 部 件 装配 、 压 力 
加 载 、 电 路 板 填充 等 方面 。 在 一 些 情况 下 ， 机 器 人 被 用 于 如 此 专 一 的 用 途 ， 以 至 于 很 难 划 清 一 台所 谓 的 机 器 人 
与 一 条 可 调整 的 “固定 的 ”自动 化 流水 线 的 界限 。 人 们 理想 中 的 机 器 人 应 该 是 能 做 “所 有 事 ” 的 万 能 机 器 ， 
忆 此 这 种 机 器 人 在 大 量 出 售 以 后 价格 将 相对 便宜 。 但 是 ， 许 多 机 器 人 的 实际 情况 则 恰好 与 之 相反 。 

我 认为 机 器 人 的 概念 应 该 与 在 给 定 的 时 间 内 什么 活动 是 与 人 相关 ， 以 及 什么 活动 是 与 机 器 相关 联系 起 来 。 
如 果 一 人 台 机 器 突然 变 得 能 够 完成 我 们 通常 和 人 联系 在 一 起 的 工作 时 ， 这 人 台 机 器 就 能 在 定义 上 被 提升 而 定义 为 一 
个 机 器 人 。 过 了 一 段 时 间 以 后 ， 人 们 习惯 于 这 件 工作 由 机 器 来 完成 了 ， 这 个 装置 就 从 “机 器 人 ”降级 为 “机 
器 ”。 那 些 没有 固定 底座 和 那些 具有 用 膊 或 腿 状 附件 的 机 器 人 更 有 优势 ， 也 更 有 可 能 被 称 作 机 器 人 ， 但 是 很 难 
让 人 想到 一 套 始 终 如 一 的 定义 标准 ， 并 适合 目前 所 有 的 命名 惯例 。 

在 包括 家 用 机 器 的 所 有 机 器 中 ， 拥 有 微 处 理 器 来 指导 其 行动 的 都 可 以 认为 是 机 器 人 。 除 了 真空 吸尘器 ， 还 
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有 洗衣 机 、 冰 箱 以 及 洗 碗 机 都 能 很 容易 地 作为 机 器 人 被 推 向 市 场 。 当 然 ， 还 存在 着 很 多 的 可 能 性 ， 包 括 那 些 具 
有 环境 感知 反馈 和 判断 能 力 的 机 器 。 在 实践 里 ， 那 些 被 看 做 是 机 器 人 的 装置 中 ， 传 感 器 的 数量 和 判断 能 力 可 能 
由 很 多 、 很 强 一 直 变 化 到 完全 没有 。 

在 最 近 的 几 十 年 里 ， 对 机 器 人 的 研究 已 经 由 一 个 以 机 电 人 整合 装置 研究 为 中 心 的 学 科 壮 大 为 一 个 宽广 得 多 的 
交叉 性 学 科 。 被 称 作 以 人 为 本 的 机 器 人 领域 便 是 这 样 的 一 个 合子。 在 这 个 领域 里 ， 人 们 研究 人 和 智能 机 器 的 相 
互 作用 。 这 是 一 个 发 展 中 的 领域 ， 其 中 ， 对 机 器 人 与 人 的 相互 影响 的 研究 已 经 吸引 了 来 自 经 典 机 器 人 研究 领域 
之 外 的 专家 们 。 人 们 正在 研究 一 些 诸如 人 和 机 器 人 的 情感 之 类 的 概念 ; 而 且 一 些 像 人 体 生理 学 和 生物 学 等 古老 
的 研究 领域 正在 被 合并 成 机 器 人 研究 的 主流 。 这 些 研究 活动 将 新 的 工程 和 科学 层面 引进 到 了 研究 著述 中 ， 从 而 
丰富 了 机 器 人 研究 领域 。 

最 初 ， 初 期 的 机 器 人 界 主要 关注 让 机 器 去 干 活 。 对 于 那些 早期 的 机 器 人 装置 ， 人 们 完全 只 关注 它们 能 不 能 
干 活 ， 而 很 少 去 在 意 它们 有 限 的 性 能 。 现 在 ,我 们 拥有 精细 的 、 可 靠 的 装置 作为 机 器 人 系统 现代 阵列 的 一 训 
分 。 这 一 进步 是 全 世界 成 千 上 万 人 的 工作 成 果 ， 这 些 工作 很 多 都 是 在 大 学 、 政 府 的 研究 实验 室 和 企业 里 进行 
的 。 这 一 成 就 创造 了 包含 在 本 手册 64 章 中 的 大 量 的 信息 ， 这 是 对 全 世界 工程 界 和 科学 界 的 致敬 。 显 然 这 些 成 
果 并 非 由 任何 中 央 规 划 或 者 一 个 整体 有 序 的 计划 产生 。 因 此 本 手册 的 编者 面 对 着 将 这 些 材料 组 织 成 一 个 有 逻辑 
而 且 清 晰 明了 的 整体 的 艰巨 任务 。 

编辑 将 稿件 划分 为 三 层 结构 。 第 一 层 论述 这 门 学 科 的 基础 。 这 一 层 由 9 章 组 成 。 作 者 在 其 中 详细 讲述 了 机 
器 人 学 科 、 运 动 学 、 动 力学 、 控 制 学 、 机 构 学 、 架 构 、 编 程 、 推 理 和 传 感 。 这 些 是 组 成 机 器 人 研究 和 发 展 的 基 
本 技术 。 

第 二 层 有 四 个 部 分 。 第 一 部 分 (第 2 篇) 阐述 了 机 器 人 的 结构 ， 包 括 避 部 、 腿 、 手 和 其 他 大 多 数 机 器 人 
的 组 成 部 分 。 千 一 看 ， 腿 、 涡 部 和 手 这 些 硬件 可 能 相互 之 间 差 异 巨 大 ， 但 它们 共有 一 套 属 性 ， 使 他 们 能 够 用 相 
同 的 或 很 接近 的 、 在 第 一 层 中 描述 过 的 原理 去 分 析 。 

该 层 的 第 二 部 分 (第 3 篇 ) 涉及 传 感 和 感知 ， 它 们 是 任何 真正 独立 的 机 器 人 系统 所 必需 的 基本 能 力 。 正 
如 先前 指出 ， 实 际 上 许多 所 谓 的 机 器 人 设备 只 有 少量 的 上 述 能 力 ， 但 显然 更 先进 的 机 器 人 不 能 离开 它们 ， 并 且 
很 大 趋势 是 把 这 些 能 力 合并 到 机 器 人 设备 中 。 该 层 第 三 部 分 (第 4 篇 ) 讲述 了 这 门 学 科 领 域 和 设备 控制 与 接 
口技 术 的 联系 。 该 层 第 四 部 分 (第 5 篇 ) 由 8 章 组 成 ， 探 讨 了 移动 机 器 人 和 不 同形 式 的 分 布 式 机 器 人 。 

第 三 层 由 两 部 分 共 12 章 组 成 ， 涉 及 当今 研究 和 开发 前 沿 的 高 级 应 用 。 一 部 分 (9618) 论述 现场 和 服务 
机 器 人 ， 另 一 部 分 (第 7 篇 ) 讲述 以 人 为 本 和 仿真 机 器 人 。 对 于 外 行 读 者 ， 这 些 章节 是 先进 机 器 人 的 全 部 。 
然而 必须 意识 到 这 些 非 同 寻常 的 实现 如 果 没 有 前 两 层 所 介绍 的 发 展 ， 就 可 能 不 会 存在 。 

理论 和 实践 的 紧密 联系 促成 了 机 器 人 技术 的 发 展 ， 并 成 为 现代 机 器 人 的 一 种 特征 。 这 两 个 互补 的 方面 ， 对 
于 我 们 当中 那些 同时 拥有 机 会 研究 和 开发 机 器 人 设备 的 人 ， 是 个 人 成 就 感 的 源泉 。 本 手册 极 好 地 反映 了 学 科 的 
这 两 个 互补 方面 ， 并 展现 近 五 十 年 来 的 大 量 研究 成 果 。 一 些 人 将 要 发 明 更 有 能 力 的 多 样 的 下 一 代 机 器 人 设备 ， 
当然 ， 本 手册 的 内 容 将 作为 他 们 一 个 有 价值 的 工具 和 各 导 引 。 向 编辑 和 作者 致 以 祝贺 与 崇敬 。 


Bernard Roth 
美国 斯 坦 福 大 学 
2007 年 8 月 
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翻 开 这 本 手册 ， 纵 观 其 64 章 丰 富 的 内 容 ， 我 们 不 妨 从 个 人 的 视角 ， 对 机 
器 人 学 在 概念 、 趋 势 及 中 心 问题 等 方面 的 演变 作 一 个 概述 。 

现代 机 器 人 学 大 约 开始 于 半 个 世纪 以 前 ， 并 向 两 个 不 同 的 方向 发 展 。 

首先 ， 让 我 们 了 解 一 下 机 械 民 涉及 的 范围 ， 从 对 遭受 辐射 污染 产品 的 远 
程 作业 到 工业 机 械 手 ， 无 不 包含 在 其 领域 中 ， 而 这 之 中 标志 性 机 器 UNIMATE 
是 通用 机 械 手 的 代表 。 产 品 的 工业 发 展 ， 大 多 围绕 六 自由 度 串 联 图 景 以 及 积 
极 的 研究 和 开发 ， 将 机 械 工程 与 控制 专业 化 联系 在 一 起 ， 成 为 其 发 展 的 主要 
推动 力 。 当 今 特 别 值得 关注 的 是 ， 通 过 对 先进 的 功能 强大 的 数学 工具 的 运用 ， 
在 新 颖 的 应 用 优化 结构 设计 方面 的 努力 终于 获得 了 回报 。 类 似 的 ， 为 实现 制 


造 出 与 人 类 友好 的 机 器 人 的 梦想 ， 一 项 关于 未 来 认 知 机 器 人 的 辟 和 手 的 设计 Georges Giralt 

与 实际 建造 也 引起 了 人 们 的 重视 。 法 国 拉 斯 - 国家 科学 研究 中 心 
其 次 ， 还 未 被 人 类 充分 认识 但 我 们 应 该 清楚 的 是 涉及 人 工 智 能 相关 主题 (LAAS-CNRS) 研究 主管 ， 

的 系列 工作 。 在 此 领域 中 具有 里 程 碑 意 义 的 项 目 便 是 斯 坦 福 国际 集团 开发 的 图 卢 效 


移动 机 器 人 Shakey。 这 项 旨 在 集 计 算 机 科学 、 人 工 智能 和 应 用 数学 于 一 身 发 

展 智能 机 器 的 工作 ， 至 今 作为 一 个 子 领域 已 经 有 一 段 时 间 了 。20 世纪 80 年 代 

期 间 ， 通 过 对 围绕 包括 从 极端 环境 下 的 探测 器 (如 星球 探测 ， 南 极 洲 等 ) 到 服务 机 器 人 (如 医院 ， 博物馆 引 
导 等 ) 等 宽广 范围 的 个 案 研究 获得 的 建设 强度 ， 引 发 了 大 范围 的 研究 ， 从 而 也 莫 定 了 智能 机 器 人 的 地 位 。 
因此 机 器 人 学 的 研究 能 够 将 这 两 个 不 同 的 分 支 联系 起 来 ， 将 智能 机 器 人 以 一 种 纯粹 的 计算 方式 分 类 为 有 限 
理性 机 器 ， 这 是 在 20 世纪 80 年 代 第 三 代 机 器 人 定义 的 基础 上 进行 了 扩展 : 

< (机 器 人 ) se 作为 一 个 通过 智能 将 感知 和 行动 联系 在 一 起 ， 而 被 赋予 了 对 一 项 工作 拥有 理解 、 推 断 并 
执行 能 力 的 机 器 ， 在 三 维 的 世界 里 执行 操作 。” 

作为 一 个 广泛 认可 的 测试 平台 ， 自 主机 器 人 领域 最 近 从 机 器 人 设计 方面 的 突出 贡献 中 受益 颇 多 ， 而 这 些 贡 
献 是 通过 在 环境 建 模 及 机 器 人 定位 上 运用 算法 几何 及 随机 框架 法 (SLAM， 同 步 定位 和 建 模 ) ， 以 及 运用 贝 叶 
斯 估计 和 决策 方法 所 带 来 的 决策 程序 的 发 展 等 综合 取得 的 。 

在 千 禧 年 的 过 去 十 年 间 ， 机 器 人 学 主要 处 理智 能 机 器 人 图 景 ， 在 一 个 覆盖 了 先进 传 感 和 知觉 、 任 务 推理 和 
规划 、 操 作 和 决策 自动 化 、 功 能 性 整合 架构 、 智 能 人 机 接口 、 安 全 和 可 靠 性 等 项 目的 主题 和 内， 将 机 器 人 和 机 器 
智能 通用 研究 结合 起 来 。 

第 二 个 分 支 数 年 来 被 认为 是 非 制 造 机 器 人 学 的 ， 涉 及 大 量 有 关 现场 、 服 务 、 辅 助 以 及 后 来 的 个 人 机 器 人 
的 、 以 研究 为 驱动 的 真实 世界 的 案例 。 这 里 ， 机 器 智能 在 其 多 个 主题 内 是 中 心 研究 方向 ， 使 得 机 器 人 能 够 在 以 
下 三 个 方面 得 以 行动 : 

1) 作为 人 类 的 替代 者 ， 尤 其 是 对 于 远程 或 恶劣 环境 中 的 于 预 工作 。 

2) 通过 与 人 友好 机 器 人 学 或 以 人 为 本 机 器 人 学 的 所 有 实际 应 用 ,与 人 类 的 亲近 交互 及 在 人 类 环境 中 的 
操作 。 

3) 与 使 用 者 的 紧密 协同 ， 从 机 械 外 骨骼 辅助 、 外 科 手 术 、 保 健 和 康复 扩展 到 人 类 隆胸 。 

为 此 ， 在 千年 之 交 ， 机 器 人 学 已 经 成 为 一 个 广泛 的 研究 主题 ， 不 仅 有 对 于 工程 化 很 好 的 工业 领域 支持 市 场 
产品 ， 同 时 也 有 大 量 在 危险 环境 中 操作 的 领域 导向 的 应 用 案例 ， 如 水 下 机 器 人 、 复 杂 地 形 车 、 医 疗 / 康 复 机 器 
人 学 等 。 

机 器 人 学 的 发 展 水 平 重点 看 理论 方面 所 扮演 的 角色 ， 目 前 它 已 经 从 应 用 领域 发 展 到 技术 和 科学 的 领域 。 这 
本 手册 的 组 织 构架 很 好 地 阐释 了 这 些 不 同 的 水 平 。 此 外 ， 为 了 未 来 认 知 型 机 器 人 ， 除 了 大 量 的 软件 系统 ， 人 们 
还 需要 考虑 与 人 友好 的 环境 中 的 机 器 人 物理 性 质 和 新 奇 附件 ， 包 括 腿 、 怖 和 手 的 设计 。 
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在 当前 千 禧 年 的 前 十 年 ， 前 沿 的 机 器 人 学 正在 取得 突出 的 进步 ， 通 常 由 以 下 两 个 方向 组 成 : 

1) 中 /短期 面向 应 用 的 案例 研究 。 

2) 中 /长 期 一 般 情况 的 研究 。 

为 了 完整 性 ， 我 们 需要 提 到 大 量 外 围 的 、 激 发 机 器 人 学 灵感 的 学 科 ， 这些 学 科 经 常 是 关于 娱乐 、 广 告 和 精 
致 的 玩具 。 

与 人 友好 机 器 人 学 的 前 没 领域 包括 几 个 一 线 的 应 用 领域 ， 在 这 些 领域 里 ， 机 器 人 (娱乐 、 教 育 、 公 共 服 
务 、 辅 助 和 个 人 机 器 人 等 ) 在 人 类 环境 或 者 在 和 人 类 密切 相互 作用 的 环境 里 运作 。 这 里 也 就 介绍 了 人 机 交互 
的 关键 性 问题 。 

正 是 在 这 个 领域 的 中 心 ， 浮 现 出 来 个 人 机 器 人 的 前 沿 的 课题 ， 对 此 ， 在 这 里 我 们 着 重 强调 它 的 三 个 总 体 
THE: 

1) 它们 可 能 由 非 专 业 使 用 者 操作 。 

2) 它们 可 能 被 设计 来 和 使 用 者 分 享 高 水 平 的 决定 。 

3) 它们 可 能 包含 环境 装置 和 机 器 附件 、 遥 远 的 系统 ， 还 有 操作 者 。 这 种 分 享 决策 的 观念 暗示 这 里 呈现 
一 些 前 沿 研究 课题 和 伦理 问题 。 

个 人 机 器 人 的 概念 ， 正 扩大 为 机 器 人 助手 和 万 能 “伴侣 ”， 对 于 机 器 人 学 来 说 确实 是 一 项 重大 的 挑战 。 机 
器 人 学 作为 科学 和 技术 领域 的 一 个 重要 分 支 ， 提 供 了 在 中 长 期 对 社会 和 经 济 产生 重大 影响 的 观念 。 这 里 介绍 和 
质疑 前 沿 课题 包括 以 下 认 知 的 方面 : 可 协调 的 智能 人 机 交互 、 感 觉 (场景 分 析 、 种 类 识别 ) 、 开 放 式 学 习 (了 
解 所 有 的 行为 ) 、 技 能 获取 、 大 量 的 机 器 人 世界 的 数据 处 理 、 自 主 决定 权 和 可 靠 性 (安全 性 、 可 靠 性 、 交 流 和 
操作 稳定 性 ) 。 

上 面 提 到 的 两 种 方法 有 很 明显 的 协同 性 ， 尽 管 必 要 的 框架 存在 时 差 。 这 种 科学 上 的 联系 不 仅 集合 了 问题 和 
获得 结果 ， 而 且 也 在 事物 两 方面 创造 出 和 谐 的 交流 和 给 技术 带 来 进步 。 

事实 上 ， 这 种 相应 的 研究 趋势 和 应 用 领域 的 发 展 获得 了 爆炸 性 的 实用 技术 的 支持 ， 其 中 包括 计算 机 处 理 能 
力 、 通 信 学 、 计 算 机 网 络 设计 、 传 感 装置 、 知 识 检索 、 新 材料 、 微 纳米 技术 。 

今天 ， 展 望 中 长 期 的 未 来 ， 我 们 正面 对 非常 积极 的 议题 和 观点 ， 但 是 也 必须 对 有 关机 器 人 的 批评 性 意见 和 
隐 存 的 风险 做 出 回应 ,这 种 风险 就 在 于 人 们 担心 机 器 人 在 和 人 接触 的 过 程 中 也 可 能 出 现 不 需要 的 或 者 不 安全 的 
行为 。 因 此 ， 存 在 一 个 非常 清晰 的 需求 ， 那 就 是 研究 级 别 安全 问题 和 可 靠 性 与 相应 的 系统 限制 课题 。 

《机 器 人 手册 》 的 出 版 非常 及 时 ， 充 满 了 挑战 性 的 成 果 。 它 由 165 位 作者 在 64 章 中 总 结 了 大 量 的 难题 、 问 
题 和 方方面面 。 就 其 本 身 而 言 ， 它 不 仅 是 全 世界 研究 者 所 获得 的 基本 课题 和 结果 的 一 个 高 效 展示 ， 而 且 和 进一步 
给 每 一 个 人 提供 了 不 同 的 观点 和 方法 。 这 确实 是 一 个 可 以 带 来 进步 的 很 重要 的 工具 ， 但 是 ， 更 重要 的 是 ， 它 将 
在 这 个 千 禧 年 的 头 二 十 年 成 为 建立 机 器 人 学 的 开端 ， 在 机 器 智能 的 核心 领域 成 为 科学 的 学 科 。 
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机 器 人 学 领域 诞生 于 20 世纪 中 期 ， 当 时 新 兴 的 计算 机 科学 正在 改变 科学 
和 工程 中 的 每 一 个 领域 。 机 器 人 学 经 历 了 不 同 的 阶段 ， 从 婴儿 期 ， 童 年 期 到 
青年 期 ， 再 到 成 年 期 ， 已 经 完成 了 快速 而 稳健 的 成 长 。 机 器 人 学 现在 已 经 成 
熟 ， 人 们 希望 它 在 未 来 的 社会 里 提高 他 们 的 生活 质量 。 

在 机 器 人 学 的 婴儿 期 ， 它 的 核心 被 认为 是 模式 识别 、 自 动 控制 和 人 工 管 
能 。 带 着 这 些 新 的 挑战 ， 这 个 领域 的 科学 家 和 和 工程师 聚 集 在 一 起 来 审查 新 奇 
的 机 器 人 传感器 和 驱动器、 规划 和 编程 算法 以 及 连接 各 部 分 组 件 的 最 优 结构 。 
在 此 过 程 中 ， 他 们 创造 出 在 真实 世界 中 可 以 和 人 进行 交互 作用 的 机 器 人 。 这 
些 旱 期 的 机 器 人 学 集中 于 研究 手 - 眼 系 统 ， 也 就 是 人 工 智能 研究 的 试验 平台 。 


“童年 时 期 ”机 器 人 的 活动 场地 是 在 工厂 。 工 业 机 器 人 被 研究 出 来 ， 并 Hirochika Inoue 
且 应 用 到 工厂 进行 自动 喷涂 、 点 焊 、 打 磨 、 材 料 操 作 和 零件 装配 。 拥 有 传 感 日 本 东京 大 学 教授 


器 和 记忆 功能 的 机 器 人 使 工厂 更 加 自动 化 ， 使 机 器 人 的 操作 更 加 和 柔性 化 、 更 

加 可 靠 和 精确 。 机 器 人 的 自动 化 将 人 从 繁重 和 乏味 的 体力 劳动 中 解放 出 来 。 汽 车 、 家 电 和 半导体 工业 迅速 将 其 
生产 线 重 整 为 机 器 人 集成 化 系统 。 英 文 单词 “机 械 电子 ”( 又 称 为 “机 电 一 体 化 "、“ 电 子 机 械 ”) 最 早 是 由 日 
本 人 在 20 世纪 70 年 代 末 期 提出 来 的 。 它 定义 了 一 个 新 的 机 器 观念 ， 在 这 种 观念 里 ， 电 子 和 机 器 系统 相 融 合 ， 
这 种 融合 使 很 多 工业 产品 变 得 更 加 简单 、 却 又 更 加 多 功能 ， 而 且 可 编程 和 智能 化 。 机 器 人 学 和 机 械 电子 学 在 制 
造 过程 的 设计 、 操 作 和 工业 产品 上 都 产生 了 非常 积极 的 影响 。 

随 着 机 器 人 学 进入 它 的 青春 期 ， 研 究 者 雄心 勃勃 地 去 探索 它 新 的 起 点 。 运 动 学 、 动 力学 和 系统 控制 理论 变 
得 更 加 精妙 ， 同 时 它们 也 被 应 用 到 真正 的 复杂 机 器 人 的 机 构 中 。 为 了 进行 规划 和 完成 真实 的 任务 ， 机 器 人 必须 
能 够 认 知 它 所 处 的 环境 。 视 觉 一 一 外 部 感觉 的 主要 的 途径 ， 作 为 机 器 人 了 解 其 所 处 外 部 环境 的 最 普通 、 最 有 效 
的 、 最 高 效 的 手段 ， 被 开发 出 来 。 已 经 发 展 起 来 的 高 级 的 算法 和 强 有 力 的 装置 将 会 用 来 提高 机 器 人 视觉 系统 的 
速度 和 稳定 性 。 触 觉 和 力 的 传 感 系统 也 需要 发 展 ， 这 样机 器 人 可 以 更 好 地 操控 物体 。 在 建 模 、 规 划 、 认 知 、 推 
理 和 记忆 方面 的 研究 扩大 了 机 器 人 的 智能 化 特性 。 机 器 人 学 逐渐 被 定义 为 传 感 和 驱动 之 间 的 智能 连接 的 研究 。 
这 种 定义 覆盖 了 机 器 人 学 的 所 有 方面 : 三 大 科学 核心 和 一 个 整合 它们 的 综合 方法 。 事 实 上 ， 由 于 系统 综合 使 仿 
生机 器 的 创造 成 为 可 能 ， 所 以 它 已 经 成 为 一 个 机 器 人 工程 的 关键 性 方面 。 创 造 这 种 仿生 机 器 人 的 乐趣 吸引 了 很 
多 学 生 投身 到 机 器 人 学 领域 。 

在 发 展 机 器 人 学 的 过 程 中 ， 科 学 的 兴趣 被 导向 到 去 理解 人 类 的 精妙 。 人 类 和 机 器 人 的 比较 研究 在 科学 研究 
人 的 功能 建 模 方面 开辟 出 了 一 条 新 路 。 认 知 机 器 人 学 、 仿 生 行 为 、 生 物 激发 的 机 器 人 和 机 器 人 生理 心理 学 方 
法 ， 在 扩大 机 器 人 潜力 方面 达到 了 极限 。 总 的 来 说 ， 在 科学 探索 中 ， 不 成 熟 的 领域 是 稀少 的 。20 世纪 80 和 90 
年 代 ， 机 器 人 学 就 处 于 这 样 一 个 年 轻 的 阶段 ， 它 吸引 了 大 量 充满 好 奇 心 的 研究 者 进入 这 个 新 的 前 沿 领域 。 他 们 
对 该 领域 持续 的 探索 形成 该 本 富 含 科学 内 容 的 综合 性 手册 。 

随 着 机 器 人 学 科 前 沿 知识 的 掌握 ， 进 一 步 的 挑战 为 我 们 打开 了 将 成 熟 的 机 器 人 技术 应 用 于 实际 的 大 门 。 早 
期 的 机 器 人 的 活动 空间 给 工业 机 器 人 的 场所 让 路 。 内 科 机 器 人 、 外 科 机 器 人 、 活 体 成 像 技 术 给 医生 做 手术 提供 
了 强 有 力 的 工具 ， 这 使 许多 病人 免 于 病痛 的 折磨 。 人 们 期 望 诸如 康复 、 卫 生 保健 、 福 利 领域 的 新 机 器 人 能 够 提 
高 老龄 化 社会 的 生活 质量 。 机 器 人 必 将 会 遍布 于 世界 的 每 一 个 角落 一 一 天 上 、 水 下 、 太 空中 。 人 们 和 希望 能 和 机 
器 人 在 农业 、 林 业 、 矿 业 、 建 筑 业 、 和 危险 环境 及 救援 中 联手 工作 ， 并 发 现 机 器 人 在 家 务 及 在 商店 、 饭 馆 、 医 院 
服务 中 的 实用 性 。 在 无 数 的 方式 中 ， 人 们 还 是 希望 机 器 人 可 以 支持 我 们 的 生活 。 然 而 ， 从 这 方面 来 看 ， 机 器 人 
的 应 用 主要 受到 结构 化 环境 的 限制 ， 在 这 些 环境 中 ， 出 于 安全 考虑 ， 机 器 人 和 人 是 相互 隔离 的 。 在 下 一 个 阶 
段 ， 机 器 人 所 处 的 环境 将 扩展 为 非 结 构 化 的 世界 ， 在 这 里 ， 人 享受 服务 ， 将 总 是 和 机 器 人 一 起 工作 和 生活 。 在 
这 样 的 环境 中 ， 机 器 人 将 必须 具备 高 性 能 的 传感器 、 更 加 智能 化 、 强 化 的 安全 性 和 更 好 的 人 类 理解 力 。 在 寻求 
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阻碍 机 器 人 发 展 问 题 的 解答 过 程 中 ， 不 仅 应 该 考虑 技术 上 的 问题 ， 还 应 该 考虑 社会 问题 。 

自从 我 最 初 的 研究 一 使 机 器 人 变 成 一 个 奇想 ， 到 现在 ， 四 十 年 已 经 过 去 了 。 从 最 开始 就 见证 了 机 器 人 技 
术 的 成 长 我 感到 幸运 和 高 兴 。 为 了 机 器 人 学 的 诞生 ， 从 其 他 学 科 引 进 了 基础 的 技术 。 没 有 教科 书 和 手册 是 现成 
的 。 为 了 达到 目前 的 这 个 阶段 ， 许 多 科学 家 和 工程 师 已 经 挑战 了 新 的 领域 。 在 推进 机 器 人 学 的 同时 ， 他 们 从 多 
维度 的 视角 丰富 了 知识 本 身 。 他 们 努力 的 成 果 都 已 经 编辑 在 这 本 机 器 人 手册 中 了 。 这 本 出 版 物 是 百 多 位 世界 领 
军 专家 共同 合作 的 结果 。 现 在 ， 那 些 希 望 投身 于 机 器 人 学 研究 的 人 就 能 够 找到 一 个 可 以 建构 自己 知识 体系 的 坚 
实 的 基础 。 这 本 手册 必 将 会 用 于 进一步 发 展 机 器 人 学 ， 强 化 的 工程 教育 和 系统 的 知识 编辑 可 以 促进 社会 和 工业 
的 知识 创新 。 

在 老龄 化 社会 里 ， 人 类 和 机 器 人 的 角色 是 科学 家 和 工程 师 需 要 考虑 的 重要 问题 。 机 器 人 能 够 对 保卫 和 平 、 
促进 繁荣 和 提高 人 们 生活 质量 做 出 贡献 吗 ? 这 是 一 个 尚未 解决 的 问题 。 然 而 ， 最 近 个 人 机 器 人 、 家 用 机 器 人 和 
仿 人 机 器 人 的 进步 间接 表明 机 器 人 从 工业 部 门 到 服务 业 部 门 的 转移 。 为 了 实现 这 种 转移 ， 机 器 人 学 不 可 回避 这 
样 的 观点 ， 那 就 是 机 器 人 学 工作 的 基础 包含 了 社会 学 、 生 理 心 理学 、 法 律 、 经 济 、 保 险 、 伦 理 、 艺 术 、 设 计 、 
戏剧 和 运动 科学 。 将 来 的 机 器 人 学 应 该 被 作为 包含 人 类 学 和 技术 的 学 科 来 研究 。 这 本 手册 有 选择 地 提供 了 推进 
机 器 人 学 这 个 新 兴 科 学 领域 的 技术 基础 。 我 期 待机 器 人 学 持续 不 断 的 进步 ， 期 待 它 能 够 促进 未 来 社会 的 繁荣 。 


Hirochika Inoue 
日 本 东京 
2007 年 9 月 


机 器 人 已 经 
将 传 感 和 动作 联 
到 20 世纪 20 年 
界 并 能 恰当 工作 
了 对 真正 机 器 人 的 描述 
+, m EZ E 
界 中 ， 动 作 却 越 来 越 
器 人 再 一 次 在 少数 研究 实验 室 出 现 。 


研究 热潮 和 遍布 世界 的 智能 机 器 人 大 
了 目前 领域 机 器 人 的 研究 现状 。 


处 理 、 知 能、 动作 到 


让 人 类 着 迷 了 几 千 年 。 在 20 世纪 之 前 制造 的 机 器 人 没有 
系 起 来 ， 只 是 通过 人 力 或 者 是 重复 性 的 机 器 来 驱动 。 
信 ， 电 子 登 上 舞台 之 后 ， 才 制造 出 了 第 一 
的 机 器 人 。 在 1950 年 前 ， 

。20 世纪 60 年 代 ， 工 业 机 器 人 进入 了 人 们 的 视 
门 对 环境 越 来 越 不 敏感 ， 而 在 它们 自己 的 工程 化 
快 。20 世纪 70 年 代 中 期 ， 
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直 
台 真 正 感 知 世 
看 到 流行 杂志 中 出 现 


我 们 开始 


在 法 国 、 日 本 和 美国 ， 机 
现在 我 们 已 经 迎 来 了 一 个 世界 性 的 
MERRIER R AEM R 
从 机 器 人 的 机 械 装 置 、 感 应 和 知觉 


许多 应 用 领域 ， 本 书 都 有 涉及 。 


Rodney Brooks 
美国 麻 省 理工 学 院 教授 


我 非常 幸运 地 生活 在 过 去 30 年 来 机 器 人 的 研究 革命 之 中 。 在 澳大利亚 ， 当 我 还 是 一 个 少年 的 时 候 ， 在 


1949 年 和 1950 年 我 受到 Walter 在 《 科 


年 抵达 硅谷 时 ， 恰 好 是 计算 机 个 人 


机 器 人 “The Cart” 在 6 个 小 时 之 内 和 


能 实验 室 ，Sebastian Thrun 和 他 的 团 
之 中 就 提高 了 4 个 数量 级 ， 


我 们 已 经 远离 了 那样 的 机 器 人 ， 
期 ， 机 器 人 已 经 察 过 了 肉体 和 机 器 


献 者 。 
本 手册 介绍 的 研究 结果 提 


队 
比 每 两 年 就 翻 一 番 的 速度 还 
在 数量 上 也 增加 了 。 我 在 1977 年 刚 到 斯 坦 福 人 工 管 


成 也 有 类 似 的 壮大 发 展 ， 尽 管 提 供 一 
境 ， 人 距离 一 起 工人 


学 美国 人 》 中 所 描述 


在 1979 年 我 已 经 可 以 协助 斯 坦 福 人 工 智 能 实验 室 (SAIL) 的 Hans Moravec 工作 了 ， 当 时 他 正在 耐心 地 使 
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的 乌龟 的 启发 ， 制 作 了 一 个 机 器 人 。 当 我 在 1977 
比 革命 真正 开始 的 时 候 ， 但 是 我 转向 了 更 为 模糊 的 机 器 人 世界 的 研究 当中 。 


rnm 


E 


行驶 20 米 。 就 在 26 年 之 后 的 2005 年 ， 在 同样 的 实验 室 一 一 斯 坦 福 人 工 管 


BOE 


FE — Rs 


个 简洁 


音韵 律 当中 


供 了 推动 机 器 人 伟大 进步 的 关键 想法 。 参 与 和 部 分 参与 工作 的 编辑 们 和 所 有 


者 把 这 些 知 识 汇 集 起 来 ， 完 成 了 一 项 一 流 的 工作 。 这 项 工作 将 会 为 机 器 人 的 进一步 研发 提 


并 祝贺 所 有 在 这 项 关键 工作 中 
对 一 些 未 来 机 器 人 的 研究 


我 相信 能 
力 时 的 年 龄 


描述 为 ; 


e 一 个 两 岁 小 孩子 的 物体 认 知 能 


e 一 个 


四 岁 小 孩子 的 语言 BH 能 力 。 


付出 劳动 的 人 们 。 

将 通过 采用 和 改善 技术 得 以 增加 。 

这 些 研 究 的 基础 会 与 一 些 观念 以 及 本 书 所 述 
当 你 在 研究 本 书 ， 寻 找 一 些 领域 来 通 

力 和 灵感 会 使 机 器 人 更 加 有 用 ， 更 加 高 产 ， 更 容易 被 接受 。 


的 现 有 技术 发 展 水 平 相反 。 


过 你 自己 的 才华 和 努力 对 机 器 人 研究 


未 来 机 器 人 研究 的 其 他 方面 将 会 更 具 革 命 


做 出 贡献 的 


的 


供 基础 。 谢 谢 你 


时 候 ， 我 想 提醒 


已 经 可 以 使 机 器 人 在 6 个 小 时 之 内 自动 行驶 200000 米 了 ， 在 仅仅 26 年 
但 是 ， 机 器 人 不 仅仅 是 在 速度 上 提升 了 ， 
9 能 实验 室 的 时 候 ， 世 界 上 只 有 3 合 移动 机 器 人 在 运行 。 
近 ， 我 投资 建立 的 一 个 公司 制造 了 第 3000000 人 台 移 动机 器 人 ， 并 且 我 们 制造 的 步伐 还 在 加 快 。 机 器 人 的 其 1 
的 数字 化 的 描述 更 难 一 些 。 以 前 ， 机 器 人 太 不 清楚 它们 周围 的 
FE 非常 不 安全 ， 而 且 机 器 人 也 根本 意识 不 到 人 们 的 存在 。 但 是 近 
还 制造 出 了 可 以 从 人 们 的 面部 表情 和 声 
的 界限 ， 所 以 现在 我 们 正在 看 到 
术 的 机 器 人 到 为 残疾 人 设计 的 康复 机 器 人 。 最 近 


它们 


E 


取 


也 领 


环 


E 
领悟 其 暗示 的 机 器 人 。 近 
一 系列 的 智能 机 器 人 ， 包 括 从 会 修复 牵引 
， 机 器 人 已 经 成 为 了 认 知 科学 和 智能 科学 研究 中 受 尊敬 的 贡 


作 


我 把 这 些 能 力 按照 一 个 小 孩子 拥有 同等 能 
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e 一 个 六 岁 小 孩子 的 灵巧 能 

e 一 个 八 岁 小 孩子 的 社会 理解 能 

达到 上 述 每 一 个 程度 都 是 非常 困难 的 目标 。 但 是 即使 是 朝向 以 上 任何 一 个 目标 的 微小 进步 也 将 会 立即 应 用 
在 外 面世 界 的 机 器 人 上 。 当 你 进一步 对 机 器 人 学 有 所 贡献 之 时 ， 好 好 阅读 本 书 并 祝 你 好 运 。 


Rodney Brooks 
美国 麻 省 理工 学 院 ， 剑 桥 
2007 年 10 月 
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机 器 人 在 达到 人 类 前 沿 的 同时 ， 积 极 应 对 着 新 兴 领 域 中 出 现 的 各 种 挑战 。 新 一 代 机 器 人 和 人 类 互动 ， 和 人 
类 一 起 探索 、 工 作 ， 它 们 将 会 越 来 越 多 地 接触 人 类 及 其 生活 。 实 用 机 器 人 的 前 景 令 人 信服 是 半 个 世纪 的 机 器 人 
科学 发 展 的 结果 ， 这 种 发 展 将 机 器 人 作为 现代 科学 学 科 建 立 起 来 。 

机 器 人 领域 的 快速 发 展 推动 了 这 本 《机 器 人 手册 》 的 诞生 。 随 着 期 刊 、 会 议论 文集 和 专著 的 增加 ， 参 与 
机 器 人 科学 技术 研究 的 人 ， 特 别 是 刚 进 入 该 领域 的 人 ， 很 难 跟 得 上 它 大 范围 发 展 的 脚步 。 由 于 机 器 人 技术 是 多 
学 科 交 叉 的 技术 ， 这 个 任务 就 显得 尤为 艰难 。 

这 本 手册 依据 20 世纪 80, 90 年 代 机 器 人 学 的 发 展 成 果 ， 这 些 成 果 对 机 器 人 领域 的 研究 很 有 参考 价值 : 
《机 器 人 策略 : 规划 和 控制 》( 了 Brady，Hollerbach，Johnson，Lozano- Perez， 和 Mason, MIT 出 版 社 ，1982 ) , 《机 
器 人 科学 》 (Brady, MIT 出 版 社 ，1989) ， 机 器 人 评论 1 和 2 (Khatib, Craig, f" Lozano-Pérez, MIT 出 版 社 ， 
1989 和 1992)。 随 着 机 器 人 领域 更 大 的 扩展 以 及 向 其 他 学 科 的 日 渐 延 伸 ， 人 们 对 一 部 包含 机 器 人 基本 知识 和 先 
进发 展 的 综合 性 参考 手册 的 需求 越 来 越 强烈 。 

这 本 手册 是 世界 各 国 多 位 积极 参与 机 器 人 研究 的 作者 的 努力 成 果 。 将 各 位 作者 组 织 成 一 个 目标 明确 、 能 力 
卓越 的 团队 ， 卓 有 见地 地 介绍 覆盖 机 器 人 各 个 领域 的 知识 ， 这 是 一 项 艰巨 的 任务 。 

这 个 工程 开始 于 2005 年 5 月 ， 我们 和 施 普 林 格 欧洲 工程 主管 Dieter Merkle 及 STAR 的 资深 编辑 Thomas 
Ditzinger 一 起 参加 会 议 期 间 。 一 年 以 前 ， 我 们 和 Frans Groen —38 EZ £1 T “斯 普 林 格 先进 机 器 人 技术 ”系列 小 
册子 ， 这 个 小 册子 迅速 成 为 及 时 传播 机 器 人 技术 研究 信息 的 重要 媒介 。 

正 是 在 这 种 背景 下 ， 我 们 开始 了 这 个 具有 挑战 性 的 任务 ， 满 腔 热情 地 开始 规划 开发 技术 结构 和 构建 作者 团 
队 。 我 们 构思 了 一 部 由 3 层 架 构 、 共 7 篇 内 容 的 手册 ， 在 机 器 人 领域 已 经 建立 了 的 学 术 中 心 、 目 前 正在 进行 的 
研发 ， 以 及 新 兴 应 用 中 获取 该 领域 多 层面 的 信息 。 

第 一 层 即 第 1 篇 是 机 器 人 学 基础 。 综 合 的 方法 和 技术 包含 在 第 二 层 的 四 篇 中 ， 涵 盖 了 机 器 人 的 结构 、 传 感 
和 感知 ， 操 作 和 接口 ， 移 动 和 分 布 式 机 器 人 。 第 三 层 ， 包 括 机 器 人 技术 在 两 个 领域 先进 的 应 用 ， 分 别 是 : 服务 
机 器 人 和 以 人 为 中 心 的 仿 人 机 器 人 。 

为 了 展开 上 述 各 部 分 ， 我 们 设想 建立 一 个 编辑 团队 ， 来 整理 作者 的 稿件 ， 以 组 成 各 个 章节 。 一 年 后 我 们 的 
七 人 编辑 团队 形成 了 : David Orin, Frank Park, Henrik Christensen, Makoto Kaneko, Raja Chatila, Alex Zelinsky 
和 Daniela Rus. 。 有 这 样 一 批 杰出 的 学 者 致力 于 这 个 手册 的 编辑 工作 ， 该 手册 在 学 术 领 域 一 定 是 高 质量 、 大 跨 
度 的 。 

到 2005 年 初 ， 我 们 的 作者 超过 了 1150 位 。 为 了 方便 内 部 以 及 各 个 章节 的 交叉 参照 ， 把 握手 册 的 编写 进 
度 ， 我 们 制作 了 内 部 网 站 。 第 二 年 ， 就 认真 协调 了 手册 的 内 容 。 尤 其 是 在 2005 年 和 2006 年 春季 的 两 个 全 日 制 
举行 的 讲习 班 ， 大 部 分 作者 都 出 席 了 。 

本 手册 的 每 一 章 都 由 至 少 3 个 独立 的 审 稿 人 员 进 行 审 稿 ， 通 常 都 会 包括 那 一 章 的 编辑 和 两 位 相关 章节 的 作 
者 ， 有 了 时候 也 会 由 一 些 该 领域 的 其 他 专家 进行 审阅 。 必 须 审读 两 亡 ， 有 了 时候 甚至 是 三 遍 。 在 这 个 过 程 中 ， 只 要 
认为 有 必要 ， 就 会 加 入 几 位 新 的 作者 。 本 书 大 部 分 章节 在 2007 年 夏季 之 前 已 定稿 ， 在 2008 年 早春 之 前 书稿 已 
全 部 完成 一 一 那 时 候 ， 我 们 收 到 了 10000 多 份 电子 邮件 ， 汇 集 了 来 自 165 位 作者 的 7 篇 总 共 64 章 1650 多 页 的 
内 容 ， 有 950 幅 插图 ，5500 篇 参考 文献 。 

我 们 对 作者 们 的 脑力 劳动 深 表 谢 意 ， 也 同样 感谢 审 稿 人 员 和 各 部 分 编辑 的 尽职 尽责 。 感 谢 “ 施 普 林 格 科 
学 和 工程 手册 ”的 高 级 经 理 Werner Skolaut， 他 全 力 支 持 稿 件 的 编辑 加 工 工作 ， 将 手册 的 编辑 和 审 稿 、 出 版 相 
结合 ， 很 快 成 为 了 我 们 团队 很 投入 的 一 名 队员 。 感 谢 Le-TeX 的 工作 人 员 的 高 度 专业 化 的 工作 ， 他 们 重新 排版 
了 所 有 的 文字 ， 重 绘 和 完善 了 很 多 图 稿 ， 同 时 在 校对 材料 时 及 时 地 和 作者 互动 。 
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在 出 版 手册 这 个 想法 产生 六 年 之 后 ， 这 本 手册 终于 面世 了 。 除 了 它 对 研究 人 员 的 指导 意义 以 外 ， 我 们 也 
希望 这 本 手册 能 够 吸引 一 些 新 的 研究 者 进入 机 器 人 领域 ， 激 励 这 个 充满 魅力 的 领域 几 十 年 的 莲 勃 发 展 。 每 一 
次 努力 的 完成 ， 总 会 带 来 新 的 令 人 振奋 的 挑战 。 在 这 种 时 候 我 们 都 会 提醒 我 们 的 研究 员 一 一 保持 前 进 的 
梯度 。 


Bruno Siciliano 

Oussama Khatib 

意大利 那不勒斯 大 学 、 美 国 斯 坦 福 大 学 
2008 年 4 月 


编辑 简介 


Bruno Siciliano (布鲁诺 . 西西 利 亚 诺 )，1987 年 毕业 于 意大利 那不勒斯 大 
学 ， 获 电子 工程 学 博士 学 位 。 控 制 和 机 器 人 技术 的 专家 ， 那 不 勒 斯 大 学 计算 机 和 
系统 工程 PRISMA 实验 室 主任 。 目 前 研究 力 控制 、 视 觉 伺 服 、 工 业 机 器 人 / 手 操 
作 、 轻 型 柔性 手臂 、 人 -机 器 人 交互 以 及 服务 机 器 人 。 合 著 出 版 图 书 6 本 ， 编 辑 
合 订 本 5 本 ， 发 表 期 刊 论文 65 篇 ， 会 议论 文 及 专著 章节 165 篇 ， 被 世界 各 机 构 邀 
请 作 了 85 次 讲座 和 研讨 会 。 施 普 林 格 高 级 机 器 人 报告 (STAR). 系列 、 施 普 林 格 
机 器 人 手册 的 合作 编辑 ， 众 多 有 声望 期 刊 的 编 委 会 成 员 ， 许 多 国际 会 议 的 主席 或 
联合 主席 。IEEE 会 士 和 ASME 会 士 。IEEE 机 器 人 与 自动 化 协会 (RAS) 主席 ， 
曾 担任 该 协会 技术 活动 副 主 席 和 出 版 活动 副 主 席 ， 卓 越 讲 师 ， 行 政委 员 会 和 其 他 
几 个 协会 委员 会 成 员 。 


Oussama Khatib ( 欧 沙 玛 . S42 P), 1980 年 毕业 于 法 国 图 卢 效 的 高 等 航空 航 
天 研究 所 (Sup Aer), ， 获 电子 工程 博士 学 位 。 斯 坦 福 大 学 计算 机 科学 教授 。 当 
前 主要 研究 以 人 为 本 的 机 器 人 技术 ， 以 及 关于 人 体 和 运动 合成 、 仿 人 机 器 人 、 触 觉 
远程 操控 器 、 医 疗 机 器 人 、 与 人 友好 机 器 人 的 设计 。 他 在 这 些 领域 的 研究 依赖 于 
他 从 事 25 年 的 研究 成 果 ， 发 表 论 文 200 余 篇 。 他 在 世界 各 机 构 作 了 50 多 次 主题 
报告 ， 参与 了 儿 百 次 座谈 会 和 研讨 会 。 施 普 林 格 高 级 机 器 人 报告 (STAR) 系列 、 
施 普 林 格 机 器 人 手册 的 合作 编辑 ， 担 任 知 名 机 构 和 期 刊 的 顾问 编辑 委员 会 成 员 ， 
很 多 国际 会 议 的 主席 或 联合 主席 。IEEE 会 士 ，IEEE 机 器 人 与 自动 化 协会 (RAS) 
的 卓越 讲师 ， 管 理 委员 会 成 员 。 机 器 人 研究 国际 基金 委员 会 (IFRR) 主席 ， 
获 日 本 机 器 人 协会 (JARA) 研究 与 发 展 奖 。 
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David E. Orin 

The Ohio State University 
Department of Electrical Engineering 
Columbus, OH, USA 

Orin. 1 @ osu. edu 


David E. Orin, 1976 年 毕业 于 美国 俄亥俄 州立 大 学 ， 获 电子 工程 专业 博士 学 位 。1976 一 1980 年 在 美国 凯 斯 
西 保留 地 大 学 教书 。1981 年 至 今 在 俄亥俄 州立 大 学 担任 电子 与 计算 机 工程 教授 。 目 前 致力 于 两 足 动物 的 动态 
移动 。 他 对 机 器 人 动力 学 和 双 腿 运动 做 出 过 许多 贡献 ， 已 发 表 论文 125 余 篇 。 他 从 所 在 大 学 获得 了 许多 教育 
X, IEEE 会 士 ， 担 任 多 个 国际 会 议 的 程序 委员 会 委员 。 他 因为 IEEE 机 器 人 与 自动 化 协会 (RAS) 服务 而 获得 
了 杰出 服务 奖 ， 服 务 包括 财 金 副 主席 ， 秘 书 ， 行 政委 员 会 成 员 和 会 士 评 价 委员 会 联合 主席 。 
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Frank C. Park 


Seoul National University 


Mechanical and Aerospace Engineering 


个 Seoul ，Korea 
AS 
fep@ snu. ac. kr 


Frank C. Park, 1991 年 毕业 于 美国 哈佛 大 学 ， 获 应 用 数学 博士 学 位 。1991 一 1995 年 担任 欧文 加 利 福 尼 亚 大 
学 机 械 与 航空 航天 工程 系 助理 教授 。1995 年 至 今 在 国立 首尔 大 学 机 械 与 航空 航天 工程 学 院 担任 全 职 教授 。 他 
在 机 器 人 技术 方向 的 主要 研究 兴趣 包括 机 器 人 力学 、 规 划 、 控 制 、 机 器 人 设计 与 结构 和 工业 机 器 人 。 其 他 研究 
方向 包括 非 线性 系统 理论 、 差 异 几 何 及 其 应 用 ， 还 有 相关 领域 的 应 用 数学 。IEEE 机 器 人 与 自动 化 协会 (RAS) 
fb, (IEEE 机 器 人 及 自动 化 学 报 》 资 深 编辑 。 
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Henrik I. Christensen 

Georgia Institute of Technology 

Robotics and Intelligent Machines @ GT 
Atlanta, GA, USA 

hic@ cc. gatech. edu 


Henrik I. Christensen， 美 国 亚特兰大 左 治 亚 理工 学 院 机 器 人 及 机 器 人 控制 器 的 KUKA 主席 。 分 别 于 1987 年 
和 1990 年 获 奥 尔 堡 大 学 硕士 学 位 和 博士 学 位 。 曾 在 丹麦 、 瑞 典 和 美国 任职 。 发 表 视觉 、 机 器 人 、 人 工 智能 方 
面 的 论文 250 多 篇 。 其 研究 结果 已 经 由 一 些 主要 公司 和 4 个子 公 司 进行 了 商业 化 。 任 欧洲 机 器 人 研究 网 络 
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ETS engineering test satellite 工程 试验 卫星 
EVA extravehicular activity 舱 外 活动 
F 
FARS Fagg- Arbib- Rizzolatti- Sakata TS BAA Eon - chose - 3 HH 
FE finite element 有 限 元 
FESEM field- emission SEM 场 发 射 扫描 电镜 
FIFO first- in first- out 先入 先 出 
fMRI functional magnetic resonance imaging 功能 性 磁 共 振 成 像 
FMS flexible manufacturing systems 柔性 制造 系统 
FNS functional neural stimulation 功能 性 神经 刺激 
FOPL first- order predicate logic 一 阶 谓词 逻辑 
FPGAs field programmable gate array 现场 可 编程 门 阵列 


缩 略 语 列表 


XXXIX 


HAL 
HAMMER 


HCI 
HD 
HDSL 
HEPA 
HF 
HIC 
HIP 


foot rotating indicator 
finite- state acceptors 
finite- state machine 

force sensing resistor 
finite- state transducer 
feasible solution of wrench 


fiber to the home 


global asymptotic stability 

ground- based augmentation systems 
goal- contact relaxation 

gross domestic product 

generator of modules 

geostationary Earth orbit 


gastrointestinal 


WERE RE 
有 限 状态 接收 器 
有 限 状态 机 

力 敏 电阻 

有 限 状态 传感器 
扳手 可 行 解 
光纤 到 户 


全 局 渐进 稳定 性 
也 基 增 强 系统 
目标 接触 放松 
国内 生产 总 值 
发 生 器 模块 
同步 地 球 轨道 
ELAN 


w 


Geneva International Center for Humanitarian Demining 


generalized Jacobian matrix 


Global Navigation Satellite System Landing System 


Gaussian mixture model 
Gaussian mixture regression 
global navigation systems 

global navigation satellite system 
Gaussian processes 

ground- penetrating radar 

general packet radio service 
global positioning system 
graduate robot attending conference 
geon structural description 
Gadd's severity index 

graphical user interface 
generalized ZMP 


hybrid assisted limb 


日 内 瓦 人 道 主 义 排 雷 国际 中 心 
广义 雅克 比 和 矩阵 

全 球 导航 卫星 系统 着 陆 系 统 
高 斯 混合 模型 
高 斯 混合 回归 

全 球 导航 系统 

全 球 导航 卫星 系统 
高 斯 过 程 
探 地 雷达 (地质 雷达 ) 
通用 分 组 无 线 电 业务 

全 球 定位 系统 

出 席 会 议 的 研究 生机 器 人 
几何 离子 结构 描述 模型 
盖 德 氏 严重 程度 指数 

图 形 用 户 界 面 
广义 零 力 矩 点 


混合 辅助 义 胶 


hierarchical attentive multiple models for execution and recognition 


human computer interaction 
haptic device 


high data rate digital subscriber line 


semi- high efficiency- particulate air- filter 


hard- finger 
head injury criterion 


haptic interaction point 


执行 与 识别 的 分 层 感应 多 种 模型 
人 -计算 机 交互 

Tia ita 

高 数据 传输 率 数 字 用 户 线 

亚 高 效率 过 滤器 

EFH 

头 部 伤害 度 评定 基准 

触觉 交互 点 


XL 缩 略 语 列表 


HJB Hamilton- Jacobi- Bellman 哈密 顿 一 雅克 比 一 贝尔 曼 
HJI Hamilton- Jacobi- Isaac 哈密 顿 一 雅克 比 一 艾 萨 克 
HMD head- mounted display 头 戴 式 显示 器 

HMM hidden Markov model 隐 马 尔 可 夫 模 型 

HMX high melting point explosives 高 熔点 炸药 

HO human operator 人 工 操作 者 

HRI human- robot interaction 人 -机 器 人 交互 

HRTEM high-resolution transmission electron microscopes 高 分 辩 率 透射 电子 显微镜 
HST Hubble space telescope 哈 勃 望远镜 

HSTAMIDS handheld standoff mine detection system 便携 式 地 雷 探测 需 

HTML hypertext markup language 超 文本 标记 语言 

HTN hierarchical task network 分 层 任务 网 络 

I 

Lo input/output 输入 /输出 

I3CON industrialized, integrated, intelligent construction 工业 化 、 集 成 化 、 智 能 化 建设 
IA instantaneous allocation 瞬时 配置 

IAD intelligent assist device 智能 辅助 装置 

ICA independent component analysis 独立 成 分 分 析 

ICBL International Campaign to Ban Landmines 国际 反 地 雷 组 织 

ICE internet communications engine 因特网 通信 引擎 

ICP iterative closest- point algorithm XE TIR E ex SUE 

ICR instantaneous center of rotation 转动 瞬 心 

ICRA International Conference on Robotics and Automation 机 器 人 与 自动 化 国际 会 议 
ICT information and communication technology 信息 与 通信 技术 

IDL interface definition language 接口 定义 语言 

IE information ethics 信息 伦理 

IED improvised explosive device 临时 爆炸 装置 

IEEE Institute of Electrical and Electronics Engineers 电气 与 电子 工程 师 协 会 
IETF Internet engineering task force 因特网 工程 任务 组 

IFRR International Foundation of Robotics Research 机 器 人 研究 国际 基金 会 
iGPS indoor GPS 室内 全 球 定位 系统 

IHIP intermediate haptic interaction points 中 间 触 觉 交 互 点 

IK inverse kinematics 道 运动 学 

ILP inductive logic programming 归纳 逻辑 编程 

ILS instrument landing system 仪表 着 陆 系 统 

IMTS intelligent multimode transit system 智能 多 模式 交通 系统 

IMU inertial measurement units 惯性 测量 组 件 

IOSS input- output- to- state stability 输入 -输出 - 状态 稳定 性 
IP internet protocol 互联 网 协议 

IPC interprocess communication 进程 间 通 信 

ISO International Organization for Standardization 国际 标准 化 组 织 

ISP internet service provider 物 联网 服务 提供 商 

ISS input- to- state stability 输入 -状态 稳定 性 


IST Information Society Technologies 信息 社会 技术 


缩 略 语 列表 


XLI 


JAUS 
JAXA 
JDL 
JEMRMS 


JHU 
JND 
JPL 
JSIM 
JSP 


KR 


Instituto Superior Técnico 
intrinsic tactile 
inferotemporal 
interaural time difference 


indexed time table 


joint architecture for unmanned systems 


Japan space exploration agency 


joint directors of the laboratories 


里 斯 本 高 等 技术 大 学 (葡萄牙) 


内 在 触觉 
里 下 的 
双 耳 时 间 差 
索引 时 间 表 


无 人 系统 联合 构架 
日 本 太空 探索 局 
实验 室 理 事 联 合 会 


a 


Japanese experiment module remote manipulator system 


Johns Hopkins University 
just noticeable difference 
Jet Propulsion Laboratory 
joint- space inertia matrix 


Java Server Pages 


Knowledge representation 


Laboratoire d'Analyse et d'Architecture des Systémes 


laser radar or laser detection and ranging 


local- area network 

Lie algebra rank condition 

long- baseline system 

linear constraint satisfaction program 
lateral geniculate nucleus 

light detection and ranging 

line of sight 

linear program 

linear quadratic Gaussian 

logical sensor system 

linear variable differential transformer 


locally weighted regression 


Afghanistan Mine Action Center 
mobile ad hoc network 


maximum a posteriori probability 


Monterey Bay Aquarium Research Institute 


molecular- beam epitaxy 
mobile base system 


Monte Carlo 


日 本 实验 舱 遥 控 系 统 


约翰 斯 . 和 霍 普 金 斯 大 学 (美国 ) 


恰 可 察觉 差 

喷气 推进 实验 室 
关节 空间 惯性 矩阵 
Java 动态 网 页 技术 


L 


ir 
b: 


知识 


结构 与 系统 分 析 实 验 室 (法国 


激光 雷达 或 激光 探测 和 测 蝇 


局 域 网 

李 代 数 秩 条 件 

长 基线 系统 

线性 约束 满意 方案 
外 侧 膝 状 体 核 

光 探测 和 测 距 
视线 

线性 规划 
线性 二 次 高 斯 
逻辑 传感器 系统 
线性 可 变 差 动 变压器 
局 部 加 权 回 归 


阿富汗 排 雷 行动 中 心 
移动 自 组 网 络 

最 大 后 验 概率 

蒙特 雷 湾 水 族 馆 研 究 所 
分 子 束 外 延 

移动 基站 系统 
BAERS 


i 


xu 缩 略语 列表 
MCS mission control system 任务 控制 系统 
MDP Markovian decision process 马尔 可 夫 决 策 过 程 
MST microsystem technology 微型 系统 技术 
MEMS microelectromechanical systems 微机 电 系 统 
MER Mars exploration rovers 火星 探测 漫游 者 
MESUR Mars environmental survey 火星 环境 调查 
MF Mossy fibers 苔 状 纤维 
MIA mechanical impedance adjuster 机 械 阻 抗 调节 
MIG metal inert gas 金属 惰性 气体 
MIMO multi- input multi- output 多 输入 多 输出 
MIR mode identification and recovery 模式 识别 与 恢复 
MIS minimally invasive surgery 微 创 手术 
MITI Ministry of International Trade and Industry 国际 贸易 与 工业 部 
ML maximum likelihood 最 大 似 然 
ML machine learning 机 器 学 习 
MLE maximum- likelihood estimation 最 大 似 然 估计 
MLS multilevel surface map 多 层次 的 表面 图 
MNS mirror neuron system 镜像 神经 元 系统 
MOCVD metallo- organic chemical vapor deposition 金属 有 机 物化 学 气相 沉积 
MOMR multiple operator multiple robot 多 操作 者 多 机 器 人 
MOSR multiple operator single robot 多 操作 者 单机 器 人 
MPC model predictive control 模型 预测 控制 
MPFIM multiple paired forward- inverse models 多 成 对 正 反 模型 
MPM manipulator positioning mechanism 机 械 手 的 定位 机 构 
MR multirobot tasks 多 机 器 人 任务 
MR multiple reflection 多 次 反射 
MR magnetorheological 磁 流 变 
MRAC model reference adaptive control 模型 参考 自 适 应 控制 
MRI magnetic resonance imaging 磁 共 振 成 像 
MRL manipulator retention latch 机 械 手 固定 门 锁 
MRSR Mars rover sample return 火星 采样 返回 探测 需 
MRTA multirobot task allocation 多 机 器 人 任务 分 配 
MSAS Multifunctional Satellite Augmentation System 多 功能 卫星 增强 系统 
MSER maximally stable extremal regions 最 大 限度 地 稳定 极 值 区 域 
MSM master- slave manipulator 主 从 式 机 械 手 
MT multitask 多 任务 
MT medial temporal VA isti 
MTBF mean time between failure 平均 无 故障 (稳定 ) 时 间 
MTRAN modular transformer 组 合式 变压器 
N 
NAP nonaccidental properties 非 偶 然 的 性 质 
NASA National Aeronautics and Space Agency 国家 航空 与 航天 局 (美国 ) 
NASDA National Space Development Agency of Japan 日 本 国家 宇宙 开发 厅 
NASREM NASA/NBS standard reference model 美国 航天 局 /国家 统计 局 的 标准 参考 模型 


缩 略 语 列表 
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ORB 
ORCCAD 
ORM 
ORU 


National Bureau of Standards 

National Center for Engineering in Agriculture 
National Conference on Educational Robotics 
nearness diagram navigation 

network data distribution service 

network mobility 


nanoelectromechanical systems 


国家 标准 局 (美国 ) 
国家 农业 工程 中 心 (美国 ) 
教育 机 器 人 全 国会 议 (美国 ) 
近 上 距离 导航 图 

网 络 数据 分 布 服务 

网 络 移动 

纳 机 电 系 统 


National Institute of Information and Communications Technology 


信息 与 通信 技术 国家 研究 院 (美国 ) 


National Institute on Disability and Rehabilitation Research 


networked infomechanical systems 

National Institute for Occupational Health and Safety 
National Marine Electronics Association 

neural networks 

Naval Postgraduate School 

nanorobotic manipulators 


non- uniform rational B- spline 


onboard autonomous science investigation system 
orbiter boom sensor system 

operator control units 

ordinary differential equation 

occupation health and safety 

offline programming 

optical microscope 

object request brokers 

open robot controller computer aided design 
obstacle restriction method 

orbital replacement unit 


operational- space inertia matrix 


prosthetics and orthotics 

privacy, accuracy, intellectual property, and access 
pseudo- amplitude scan 

parametric bias 

programming by demonstration 

principal contact 

Purkinje cells 

principle components analysis 

proportional- derivative 

planning domain description language 


probing environment and adaptive sleeping protocol 


残障 康复 国家 研究 院 (美国 ) 
网 络 化 信息 机 械 系统 

职业 健康 与 安全 国家 研究 院 (美国 ) 
国家 海洋 电子 协会 (美国 ) 
神经 网 络 
海军 研究 生 院 (美国 ) 
纳米 机 器 人 操作 辟 
非 均 匀 有 理 B REAR 


片上 自主 科学 调查 系统 
轨道 臂 传 感 器 系统 
操作 员 控 制 单元 

常 微分 方程 
职业 健康 与 安全 
离线 编程 
光学 显微镜 
对 象 请 求 代理 
开放 式 机 器 人 控制 占 的 计算 机 辅助 设计 
障碍 限制 方法 

轨道 更 换 单 元 
操作 空间 惯性 矩 


LT 
E 


TEUBCRUSEJE as 

隐私 性 、 准 确 性 、 知 识 产 权 和 可 获得 性 
伪 幅 度 扫描 

参数 偏差 

演示 编程 

主要 接点 

浦 肯 野 细胞 

主 成 分 分 析 

比例 -微分 

规划 域 描述 语言 

探测 环境 和 适应 性 休眠 协议 


a 


XLV 缩 略语 列表 
PET positron emission tomography 正 电 子 发 射 X 光 断 层 扫描 
PF parallel fibers 平行 纤维 
PFC prefrontal cortex 前 人 额 叶 皮 层 
PFM potential field method 势 场 法 
pHRI physical human- robot interaction 人 -机 器 人 交互 
PI policy iteration 策略 迭代 法 
PIC programmable interrupt controller DEL P EDU 
PIC programmable intelligent computer 可 编程 智能 计算 机 
PID proportional- integral- derivative 比例 - 积分 - 微分 
PIT posterior inferotemporal cortex EE UNS 
PKM parallel kinematic machine 并 联机 床 
PLC programmable logic controller 可 编程 逻辑 控制 器 
PLD programmable logic device 可 编程 逻辑 带 件 
PLEXIL plan execution interchange language 计划 执行 交换 语言 
PMD photonic mixer device 光子 混 音 设备 
PMMA polymethyl methacrylate 聚 甲 基 丙 烯 酸 甲 酯 
PNT Petri net transducers Petri 网 传感器 
POMDP partially observable MDP 部 分 可 视 化 模型 驱动 程序 设计 
PPRK palm pilot robot kit 掌上 机 器 人 套件 
PPS precise positioning system 精确 定位 系统 
PR photoresist 光 刻 胶 
PRISMA Projects of Robotics for Industry and Services ，Mechatronics and Automation 
工业 和 服务 业 机 器 人 、 机 电 与 自动 化 项 目 
PRM probabilistic roadmap method 概率 图 法 
PRN pseudorandom noise 伪 随 机 噪声 
PRS procedural reasoning system 程序 推理 系统 
PS power source 电源 
PTP point- to- point 点 到 点 
PTU pan-tilt unit 平移 -倾斜 单元 
PVDF polyvinyledene fluoride 聚 偏 二 气 乙 烯 
PwoF point- contact- without- friction 无 摩擦 的 点 接触 
PZT lead zirconate titanate A EK EAR 
Q 
QD quantum dot 量子 点 
QRIO quest for curiosity 追求 好 奇 
QT quasistatic telerobotics ERASER ED La A 
R 
R. U. R. Rossum’s Universal Robots 罗 萨 姆 的 万 能 机 器 人 
RAIM receiver autonomous integrity monitoring 接收 机 自主 完好 性 监测 
RALPH rapidly adapting lane position handler 迅速 适应 行车 位 置 处 理 
RAM random- access (volatile ) memory 随机 存 取 (挥发 性 ) 存储 器 
RANSAC random sample consensus 随机 抽样 一 致 性 
RAP reactive action packages 反应 行动 包 


缩 略 语 列表 
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ROC 
ROKVISS 
ROM 
ROTEX 
ROV 
RPC 
RPI 
RPV 
RRT 
RSS 

RT 


Robotics and Automation Society 
radial basis function 

radio- controlled 

remote center of compliance 
remote center of motion 


real- time control system 


radiofrequency 

radiofrequency identification 

receptive field weighted regression 

rate gyros 

red, green, blue 

rate- integrating gyros 

reinforcement learning 

random loop generator 

reconfigurable modular manipulator system 
recursive Newton- Euler algorithm 
recurrent neural network with parametric bias 
reaction null space 

recelver operating curve 

robotic components verification on the ISS 
read- only memory 

robot technology experiment 

remotely operated vehicle 

remote procedure call 

Rensselaer Polytechnic Institute 

remotely piloted vehicle 

rapid random tree 

realistic robot simulation 

reaction time 

room- temperature 

Radio Technical Commission for Aeronautics 
resistance temperature device 

real- time innovations 

real- time kinematics 

real- time system 

real- world interface 


robotic work station 


selective availability 
Science Applications International, Inc. 
Stanford Artificial Intelligence Laboratory 


semiautonomous navigation 


机 器 人 与 自动 化 学 会 〈 美 


fu] A PKI t 
TREE 
远程 柔顺 中 心 
远程 运动 中 心 
实时 控制 系统 


Rehabilitation Engineering Research Center on Rehabilitation Robotics 


康复 工程 研究 


射频 
射频 识别 


感受 域 加 权 回 归 
速率 陀螺 仪 


红 、 绿 、 蓝 
速率 整合 陀螺 仪 


强化 性 学 习 

随机 闭环 发 电机 
可 重 构 模块 化 机 械 臂 系统 
递归 牛顿 欧 拉 算法 


递归 神经 网 络 的 参数 偏 


反应 零 空 间 
接受 者 操作 曲线 


机 器 人 在 国 


只 读 存储 器 
Tli A BEI Scr 


遥控 车 


远程 过 程 调用 


伦 斯 勒 理 


:学院 (美国 ) 


差 


无 人 驾驶 车 /遥控 飞行 器 
快速 随机 树 
真实 机 器 人 仿真 


反应 时 间 


电阻 温度 装置 


即时 创新 


即时 运动 学 


即时 系统 


真实 世界 接口 
机 器 人 工作 站 


选择 可 用 性 


国际 科学 应 用 公司 (美国 


斯 坦 福 大 学 人 工 智能 实 


半自动 导航 


线 电 技术 委员 会 (美国 ) 


验 


i 


ED 


P 心 康复 机 器 人 组 


际 空间 站 元 件 核 查 


) 
z ( 美 


司 ) 


XLI 缩 略语 列表 
SBAS satellite- based augmentation systems 星 基 增 强 系统 
SBL short- baseline system 短 基线 系统 
SCARA selective compliance assembly robot arm 选择 性 柔顺 装配 机 器 人 臂 (平面 关节 型 机 器 人 ) 
SCI spinal cord injury Shit hi 
SDK standard development kit 标准 开发 工具 包 
SDR software for distributed robotics 分 布 式 机 器 人 软件 
SDV spatial dynamic voting 空间 动态 投票 
SEA series elastic actuator 弹性 驱动 器 系列 
SEE standard end- effector 标准 最 终 效 应 
SELF sensorized environment for life 传感器 配置 生活 环境 
SEM scanning electron microscopes 扫描 电子 显微镜 
SET single- electron transistors 单 电 子 唱 体 管 
SF soft- finger 软 手 指 
SfM structure from motion 来 自 运动 的 结构 
SFX sensor fusion effects 传感器 融合 效果 
SCAS semiglobal asymptotic stability 半球 渐进 稳定 性 
SHOP simple hierarchical ordered planner 简单 多 层次 有 序 计 划 器 
SIFT scale- invariant feature transformation 尺度 不 变 特征 变换 
SICMOD Special Interest Croup on Management of Data 数据 管理 特别 兴趣 小 组 
SIPE system for interactive planning and execution monitoring 

互动 规划 和 执行 监督 的 系统 

SIR sampling importance resampling 抽样 重要 性 重 采 样 
SISO single- input single- output 单 输入 单 输出 
SKM serial kinematic machines 串联 机 床 
SLAM simultaneous localization and mapping 即时 定位 与 地 图 构建 
SLICE specification language for ICE ICE 的 规格 语言 
SLRV surveyor lunar rover vehicle 月 球 车 
SMA shape- memory alloy 形状 记忆 合金 
SMC sequential Monte Carlo 序列 蒙特 卡 罗 
SNOM scanning near- field OM 扫描 近 场 光学 显微镜 
SOI silicon- on- insulator 硅 绝缘 体 
SOMR single operator multiple robot 单 操作 者 多 机 器 人 
SOSR single operator single robot 单 操作 这 单机 器 人 
SPA sense- plan- act 传 感 - 规划 - 执行 
SPDM special- purpose dexterous manipulator 专用 灵巧 机 械 手 
SPS standard position system 标准 定位 系统 
SR single- robot 单个 机 器 人 
SRMS shuttle remote manipulator system 航天 飞机 遥控 机 械 手 系统 
SSRMS Space shuttle remote manipulator System 航天 飞机 遥控 系统 
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B SUE 


Blas AL 火星 、 海 洋 、 医 院 、 家 庭 、 、 学 
校 ， 机 器 人 无 处 不 在 。 机 器 人 能 够 救火 ， 能 够 制造 产 
品 ， 能 够 节约 时 间 、 挽 救生 命 …… 现 如 今 ， 从 制造 
业 ， 到 医疗 保健 、 交 通 运输 以 及 对 外 层 空间 和 深海 的 
探索 ， 机 器 人 正在 对 现代 生活 的 许多 方面 产生 着 相当 
大 的 影响 。 未 来 ， 机 器 人 将 会 和 现在 的 个 人 电脑 一 样 
普及 和 私人 化 。 从 一 开始 ， 人 们 就 梦想 着 能 创造 出 既 
有 能 力 又 有 智慧 的 机 器 。 现 在 这 个 梦想 在 我 们 的 世界 
里 已 经 部 分 成 为 现实 。 

从 早期 文明 开始 ， 人 类 最 大 的 雄心 之 一 就 是 要 创 
造 出 他 们 想象 中 的 物品 。 将 人 类 从 粘土 中 塑造 出 来 的 
巨神 普罗 米 修 斯 或 是 赫 淮 斯 托 斯 锻造 的 青铜 妈 役 巨人 
泰勒 斯 (公元 前 3500 年 ) 的 传奇 证 明了 希腊 神话 
的 这 种 追求 。 埃 及 人 的 甲骨 文中 的 神 论 (公元 前 
2500 年 ) 也 许 正 是 现代 思维 机 器 的 先驱 。 巴 比 伦 人 
制造 的 漏水 计时 器 (公元 前 1400) 是 最 早 的 自动 机 
械 装 置 之 一 。 在 以 后 的 几 个 世纪 里 ， 人 类 的 创造 力 造 
就 出 许多 装置 ， 例 如 ， 有 自动 装置 的 英雄 亚历山大 剧 
院 (100 4E), 、 加 扎 里 (1200 Æ) 的 水 力 灌溉 和 类 人 


技 进 步 。 同 往常 一 样 ， 新 的 设计 会 推动 新 的 研究 和 发 
现 。 与 此 同时 ， 这 些 新 的 研究 和 发 现 又 促使 解决 问题 
方案 的 增加 ， 并 由 此 产生 新 的 概念 。 这 样 一 个 有 效 的 
循环 逐渐 交替 演变 就 催生 了 机 器 人 领域 的 知识 与 认 
知 一 一 更 准确 地 应 该 称 为 机 器 人 科学 与 技术 。 

早期 的 机 器 人 出 现在 20 世纪 60 年 代 ， 它 的 产生 
主要 受到 两 方面 技术 的 影响 : 数控 机 器 在 精密 制造 业 
的 应 用 和 对 远程 放射 性 材料 的 遥控 操作 。 这 些 主 从 式 
机 械 臂 设计 出 来 用 于 重复 人 手臂 所 做 的 “点 到 点 ” 
的 机 械 运动 ， 同 时 它们 具有 基本 的 控制 ， 并 对 环境 几 
乎 没有 感知 。 之 后 , 在 20 世纪 中 后 期 ， 集 成 电路 、 
数字 计算 机 和 微型 元 器 件 的 发 展 使 计算 机 控制 机 器 人 
的 设计 和 编程 成 为 可 能 。20 世纪 70 年 代 ， 这 些 机 器 
人 ， 也 称 为 工业 机 器 人 ， 成 为 了 柔性 制造 系统 自动 控 
制 的 必要 组 成 。 它 们 不 只 在 汽车 工业 上 得 到 了 广泛 应 
用 ， 还 被 成 功 应 用 到 其 他 工业 生产 中 ， 例 如 金属 制造 
业 、 化 工业 、 电 子 业 和 食品 工业 中 。 最 近 ， 机 器 人 还 
在 工厂 之 外 找到 了 新 的 用 武之 地 ， 例 如 它们 在 清洁 、 
搜救 、 水 下 、 太 空 以 及 医疗 应 用 等 方面 均 具 有 广泛 的 


机 和 器， 以 及 莱 昂 纳 多 : 达 芬 奇 的 难以 计数 的 极 具 创造 
性 的 设计 (1500 年 )。 在 18 世纪， 自动 控制 技术 继 
ÆR A E Ze Ae, SO Jacquer- 
Droz 的 机 器 人 家 庭 ( 画家、 音乐 家 和 作家 ) 和 kara- 
kuri- ningyo 机 械 木 偶 〈 倒 茶 和 射箭 ) 这 样 的 发 明 。 

机 器 人 的 概念 得 以 清晰 地 建立 源 于 许多 极 具 创造 
力 的 历史 产物 。 但 是 ， 真 正 的 机 器 人 还 是 要 等 到 20 
世纪 其 基础 技术 发 展 后 才能 出 现 。1920 年 ， 英 文 单 
词 “ 机 器 人 ” (robot) 脱胎 于 斯 拉夫 语 中 意思 是 奴隶 
的 单词 “robota”， 它 第 一 次 被 捷克 剧 作 家 Karel 
Capek 用 在 其 剧目 “ 罗 萨 姆 的 万 能 机 器 人 ” (Rossums 
Universal Robots) 中 。1940 4E, AS 5j L8 A zz p] fc 
来 的 道德 准则 就 被 认为 是 约束 在 众所周知 的 机 器 人 三 
原则 之 内 ， 这 个 机 器 人 三 原则 是 美 籍 俄 裔 科幻 小 说 家 
JE vu + BAY PE SESE (Isaac Asimov) 在 他 的 小 说 
《Runaround》 中 提 到 的 。 

在 20 世纪 中 期 ， 人 们 进行 了 对 人 类 智能 与 机 器 
关联 的 第 一 次 探索 ， 这 标志 着 在 人 工 智能 领域 一 个 多 
产 时 代 的 来 临 。 在 这 一 时 期 ， 第 一 台 机 器 人 变 为 现 
实 ， 这 得 益 于 在 机 械 控制 、 计 算 机 和 电子 等 领域 的 科 


应 用 。 
20 世纪 80 年 代 ， 机 器 人 学 被 定义 为 研究 感知 与 
行动 之 间 智 能 连接 的 一 门 科学 。 根 据 这 一 定义 ， 机 如 
人 通过 安装 移动 装置 ( 轮子、 履带 率 引 装置 、 腿 、 
RIEK) 来 实现 在 空间 中 的 移动 ,通过 操作 装置 
CER, Amp Tae. BU) 来 对 物体 进行 加 工 ， 其 
中 ， 一 些 合适 的 装置 赋予 了 机 融 人 具有 人 的 灵性 。 通 
过 分 析 由 传感器 得 来 的 机 器 人 的 状态 参数 (位 置 、 
速度 ) 以 及 与 周边 环境 相关 的 参量 ( 力 和 触觉 、 距 
离 和 视野 ) ， 机 器 人 就 具有 了 感觉 ， 而 其 智能 连接 是 
通过 一 个 经 过 了 编程 、 规 划 和 控制 的 控制 架构 来 实现 
的 ， 这 种 结构 依赖 于 机 带 人 的 感觉 和 动作 模式 、 周 而 
环境 ， 以 及 自身 学 习 能 力 和 技能 习 得 过 程 。 

在 20 世纪 90 年 代 ， 人 类 诉 诸 机 器 人 的 各 种 需求 
推动 了 机 器 人 研究 的 发 展 。 这 些 需求 包括 在 危险 的 时 
候 解 决 人 类 的 安全 问题 CEPA A) ， 或 提高 人 类 
的 操作 能 力 并 且 降 低 人 类 疲劳 程度 (人 类 机 能 增 
强 ) ， 或 实现 一 些 人 在 充满 潜力 的 市 场 里 开发 产品 从 
而 改善 生活 质量 的 愿望 CIR SS MLA AL). HE 
景 的 一 个 共同 之 处 就 是 它们 必须 运作 在 一 个 几乎 非 结 
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构 化 的 环境 中 ， 最 终 达 到 增加 能 力 和 获得 更 高 程度 自 
主权 的 要 求 。 

在 新 千年 来 临 之 际 ， 机 器 人 技术 在 范围 和 维度 上 
经 历 了 重大 变革 。 这 种 扩张 使 机 器 人 领域 变 得 成 熟 ， 
也 使 其 相关 技术 获得 了 进步 。 机 器 人 技术 已 经 从 具有 
主导 优势 的 工业 热点 开始 迅速 扩展 到 成 为 人 类 世界 的 
挑战 (以 人 为 本 和 类 生命 机 器 人 )。 人 们 期 望 新 一 代 
的 机 器 人 可 以 与 人 安全 地 、 可 靠 地 在 家 庭 、 工 作 场 所 
共处 ， 在 社区 提供 服务 ， 在 娱乐 业 、 教 育 行业 、 医 疗 
保健 行业 、 制 造 业 等 方面 提供 支持 和 援助 。 

除去 实体 机 器 人 的 冲击 外 ， 智 能 机 器 人 的 发 展 揭 
示 了 在 不 同 研究 领域 和 学 科 内 可 以 开发 出 更 为 广泛 的 
应 用 ， 例 如 : 运动 生物 力学 、 触 党 学 、 神 经学、 模拟 
仿真 学 、 动 画 制 作 、 外 科 手 术 和 传 感 网 络 学 科 等 。 作 
为 回报 ， 新 兴 领 域 的 挑战 证 明了 机 器 人 领域 具有 如 此 
多 样 化 的 增产 措施 和 启示 。 最 引 人 注 目的 进展 往往 就 
诞生 于 学 科 的 交叉 处 。 

现在 ,伴随 着 越 来 越 多 的 机 器 人 核心 连接 的 研 
究 ， 以 机 器 人 用 户 和 研发 者 为 主 的 群体 正在 形成 。 机 


器 人 社会 的 战略 目标 就 是 与 这 些 群 体 达成 拓展 与 科研 
合作 。 而 为 了 达到 这 个 目标 ， 在 未 来 所 要 进行 的 发 展 
与 可 以 预期 的 成 果 将 很 大 程度 上 依赖 于 科研 团体 的 
能 力 。 

在 过 去 几 十 年 中 ， 研 究 结果 的 推广 、 文 献 期 刊 中 
记录 的 发 现 ， 以 及 学 术 会 议 上 的 讨论 对 机 器 人 的 发 展 
起 了 很 重要 的 作用 。 有 关机 器 人 的 科技 活动 已 经 引领 
了 专业 群体 的 成 立 ， 并 且 使 研究 网 络 开始 转向 这 个 领 
域 。 世 界 各 地 研究 机 构 在 机 器 人 学 方面 的 研究 生计 划 
的 介绍 ， 清 晰 地 展示 了 在 机 器 人 学 这 一 科学 领域 中 科 
人 研 已 经 能 够 达到 的 完善 程度 。 

机 器 人 学 的 密集 研究 情况 已 经 记录 在 了 有 具有 独特 
价值 的 参考 文献 中 ， 这 些 文献 旨 在 搜集 国际 机 器 人 科 
学 共同 体 的 意义 非凡 的 成 果 。 

《机 器 人 手册 》 一 书 从 学 科 基 础 说 起 ， 从 研究 领 
域 ， 直 至 最 新 出 现 的 机 器 人 应 用 ， 展 现 了 机 器 人 学 领 
域 的 一 幅 全 景 图 。 本 书 在 逻辑 上 材料 的 组 织 可 以 分 为 
三 个 层次 ， 它 们 分 别 反映 了 机 器 人 领域 的 历史 发 展 ， 
如 图 1 所 示 。 


图 1 本 手册 的 结构 品 


第 一 层 (第 1 篇 , 包含 9 章 ): 机 器 人 学 基础 ， 
包括 机 器 人 的 力学 、 感 觉 、 设 计 和 控制 。 第 二 层 包 括 : 
统一 的 方法 论 和 机 器 人 构造 技术 (第 2 篇 ,包含 9 
章 ) ， 传 感 与 感知 (第 3 篇 ， 包 含 7 章 ) ， 操 作 与 接口 
(第 4 篇 ,包含 8 章 )， 移动 式 和 分 布 式 机 器 人 技术 


(第 5 fi, 包含 8 章 ) 。 第 三 层 则 致力 于 更 先进 的 应 用 ， 
比如 野外 和 服务 机 器 人 (第 6 篇， 包含 14 XE) 以 及 以 
人 为 中 心 和 类 生命 机 器 人 (第 7 篇 ,， 包含 9 章 ) 。 

第 1 篇 介绍 了 在 模型 、 设 计 和 控制 机 器 人 系统 中 
用 到 的 基本 原则 和 方法 。 包 括 运动 学 、 动 力学 、 力 学 


O 图 !1 为 原 书 结构 ， 翻 译 成 中 文 后 ， 经 重新 编排 ， 本 手册 共 分 三 卷 出 版 ， 分 别 为 《机 器 人 手册 第 1 卷 机 器 人 基础 》 
《机 器 人 手册 第 2 卷 机 器 人 技术 》《 机 器 人 手册 第 3 卷 机 器 人 应 用 》。 
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设计 和 了 驱动、 感觉 和 评价 、 运 动 规划 、 运 动 控制 、 力 
控制 、 机 器 人 体系 结构 与 程序 设计 、 用 于 任务 规划 和 
学 习 的 机 器 人 智能 推理 方法 。 本 篇 每 一 章 分 别 曾 述 了 
上 述 的 某 个 主题 。 在 后 续 部 分 中 ， 这 些 主题 将 被 拓展 
和 应 用 到 特殊 的 机 器 人 结构 和 系统 中 。 

第 2 篇 涉及 机 器 人 在 实际 物理 实现 过 程 中 的 设 
计 、 模 型 、 运 动 计划 和 控制 等 问题 。 包 括 一 些 更 加 明 
显 的 机 絮 人 结构 ， 如 辟 、 腿 、 手 ， 轮 式 移 动机 器 人 和 
平台 ， 以 及 一 些 在 毫米 、 纳 米 量 级 的 机 器 人 结构 。 其 
中 一 些 章节 阐述 了 评价 指标 和 模型 辨识 ， 并 成 功 分 析 
了 串联 元 余 度 机 构 、 并 联机 构 、 柔 性 机 器 人 、 机 器 
手 、 机 器 腿 ， 轮 式 机 器 人 以 及 微米 和 纳米 扩 度 机 
ait A 


第 3 篇 涵盖 了 机 器 人 的 不 同感 觉 形态 和 跨 时 空 传 
感 数 据 整 合 。 这 将 用 于 生成 机 器 人 模型 及 外 部 环境 。 
机 器 人 学 是 感知 和 行动 的 智能 耦合 。 第 3 篇 内 容 是 对 
第 2 篇 的 补充 ， 着 重 于 继续 建立 一 个 系统 。 本 篇 包括 
接触 感知 、 本 体感 知 和 外 体感 知 ， 同 时 展示 了 主要 的 
传 感 融 类 型 ， 如 触觉 、 视 觉 里 程 计 、 全 球 定位 系统 、 
测 距 和 视觉 。 还 包含 了 基本 的 传感器 模型 和 多 传感器 


移动 机 器 人 背景 下 补充 了 第 1 篇 的 基础 原理 ， 给 出 了 
感知 的 角色 地 位 ， 在 传 感 方面 与 第 3 篇 紧密 联系 。 另 
外 ， 还 讨论 了 多 机 器 人 交互 和 系统 、 模 块 化 、 可 重 构 
机 器 人 ， 也 介绍 了 网 络 机 器 人 。 
第 6 篇 介绍 野外 机 器 人 和 可 在 所 有 环境 中 工作 的 
用 型 服务 机 器 人 。 包 括 工 业 机 器 人 ， 各 种 各 样 的 在 
海 、 陆 、 空 、 航 天 领域 应 用 的 机 器 人 ， 直 至 教学 机 央 
人 。 本 篇 以 第 1 篇 ~ 第 5 篇 的 内 容 为 基础 ， 描 述 了 如 
何 令 机 器 人 工作 。 
第 7 篇 介绍 了 如 何 创建 在 以 人 为 中 心 的 环境 中 工 
作 的 机 器 人 ， 包括 仿 人 或 称 为 拟人 ) 或 者 仿 其 他 
生物 外 观 的 机 器 人 的 设计 、 传 感 、 传 动 、 驱 动 与 控制 
结构 ， 演 示 编 程 和 安全 性 编程 的 用 户 界 面 内 容 ， 机 内 
人 的 社会 伦理 性 启示 。 

本 手册 不 仪 为 机 器 人 专家 而 写 ， 也 为 将 机 絮 人 作 
为 扩展 领域 的 初学 者 工程师、 医师 、 计 算 机 科学 
家 和 设计 师 ) 提供 了 宝贵 的 资源 。 尤 其 要 强调 的 是 ， 
第 1 篇 的 指导 价值 对 于 研究 生 和 博士 后 很 重要 ， 第 2 
篇 ~ 第 5 篇 对 于 机 器 人 领域 所 覆盖 的 研究 有 着 很 重要 
的 科研 价值 ， 第 6 篇 和 第 7 篇 对 于 对 新 应 用 感 兴趣 的 


E 


信息 融合 。 其 中 关于 感觉 融合 的 章节 介绍 了 路 时 空 感 
觉 信息 集成 所 需 的 数学 工具 。 
第 4 篇 介绍 了 机 器 人 与 物体 之 间 ， 机 器 人 与 人 之 
间 ， 机 器 人 之 间 的 交互 。 操 作 能 通过 辟 或 手指 的 直接 
接触 或 仅仅 是 推动 来 处 理 一 个 物体 。 接 口 能 使 人 机 交 
互 变 得 直接 或 间接 。 为 了 提高 机 器 人 操作 的 灵巧 度 ， 
本 篇 的 前 半 部 分 介绍 了 诸如 操作 任务 的 动作 、 接 触 模 
拟 和 操作 、 抓 取 、 协 同 操作 等 问题 。 为 实现 更 熟练 的 
操作 或 更 强大 的 人 /机 系统 ， 后 半 部 分 讨论 了 触觉 理 
论 、 遥 操作 机 器 人 、 网 络 愧 控 机 器 人 和 让 人 类 机 能 增 
强 的 外 骨骼 系统 。 

第 5 篇 涵盖 了 各 种 问题 ， 介 绍 了 轮 式 机 器 人 运动 
规划 和 控制 ， 同 时 考虑 了 运动 约束 条 件 、 认 知 和 世界 
模型 、 同 步 定 位 与 建 图 、 控 制 架构 方面 的 集成 等 的 影 
响 。 移 动机 器 人 确实 是 复杂 集成 系统 的 典范 。 本 篇 在 
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- 程 师 和 科学 家 有 着 很 大 的 附加 价值 。 

本 书 各 章 的 内 容 均 经 过 仔细 其 酌 ， 待 验证 的 方法 
和 尚未 完全 成 立 的 方法 均 未 列 人 。 本 手册 从 客观 的 角 
度 出 发 ， 包 含 多 种 方法 ， 具 有 高 的 收藏 价值 。 每 章 都 
有 一 个 简短 的 摘要 ， 并 且 在 概述 部 分 介绍 了 相关 领域 
的 技术 发 展 水 平 。 主 体 部 分 是 以 一 种 教学 方式 来 阐述 
的 。 尽 可 能 避免 元 长 的 数学 推导 ， 方 程 、 表 格 和 算法 
均 以 便于 使 用 的 形式 给 出 。 最 后 一 节 给 出 了 结论 和 题 
目 ， 以 供 进一步 阅读 。 

从 机 器 人 的 基础 开始 到 最 后 讲述 机 器 人 的 社会 意 
义 和 伦 理 启示 ， 本 书 的 64 章 全 面 收集 了 机 器 人 领域 
在 50 年 之 中 的 进展 。 这 是 对 机 器 人 领域 取得 成 就 的 
一 种 证 明 ， 也 是 将 来 新 的 前 沿 机 器 人 取得 更 大 进展 的 
保证 。 
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6 第 1 篇 


机 器 人 学 基础 


第 1 篇 机 器 人 基础 介绍 了 用 于 开发 机 器 人 系统 的 
基本 原理 和 方法 。 为 了 完成 关于 机 器 人 理论 的 任务 ， 
已 经 攻破 了 许多 运动 学 、 动 力学 、 设 计 、 驱 动 、 传 
感 、 运 动 规划 、 控 制 、 程 序 设 计 和 任务 规划 中 的 挑战 
性 难题 。 本 篇 章节 阐述 了 上 述 领 域 里 的 最 基本 的 问 
题 。 其 中 关于 机 器 人 的 一 些 基本 问题 概述 如 下 。 通 
常 ， 机 器 人 有 多 个 自由 度 ， 所 以 它 可 以 完成 一 系列 必 
需 的 三 维 运动 。 为 了 完成 一 项 任务 ， 关节 驱动 器 的 运 
动 和 转 和 矩 、 要 求 的 运动 和 力 的 运动 学 和 动力 学 关系 会 
非常 复杂 。 为 了 完成 要 求 的 动作 ， 连 杆 、 关 节 结 构 、 
驱动 的 设计 也 是 一 项 挑战 。 机 需 人 是 非 线 性 耦合 系 
统 ， 其 动力 学 非常 复杂 ， 因 此 难于 控制 。 当 环境 变 得 
不 确定 时 ， 控 制 机 器 人 将 会 变 得 更 加 复杂 ， 所 以 也 就 
需要 精确 的 传 感 和 估计 技术 。 

除了 控制 运动 ， 当 操控 物体 或 者 与 人 交互 时 ， 就 
需要 控制 机 器 人 和 环境 间 的 相互 作用 力 。 一 项 基本 的 
机 器 人 学 任务 就 是 让 复杂 物体 ， 在 充满 了 障碍 物 的 场 
地 ， 从 出 发 点 运动 到 目的 地 而 不 与 任何 障 但 物 发 生 碰 
撞 ， 这 是 一 个 非常 环 手 的 计算 难题 。 为 了 达到 人 类 的 
智能 ， 机 融 人 需要 装备 一 些 精密 的 任务 规划 控制 器 ， 
这 种 装置 可 以 部 分 感知 环境 ， 在 动力 学 方面 拥有 一 些 
象征 性 的 分 析 判 断 能 力 。 机 器 人 的 软件 构架 因为 这 些 
需求 也 相应 地 会 有 一 些 特殊 要 求 。 

本 篇 将 详细 阐述 ， 以 上 段落 概要 介绍 的 基本 问 
题 ,但 是 更 加 深入 的 了 解 需要 参照 其 他 相关 手册 。 本 
篇 介绍 的 运动 学 、 动 力学 、 机 械 设 计 、 控 制 原理 可 以 
应 用 到 机 器 人 的 结构 中 ,这些 结 构 包 括 辟 、 手 和 腿 
(第 2 篇 )， 也 可 以 应 用 到 机 械 辟 (第 4 篇 )、 轮 式 书 
TRA CBS). ARG HIA (Rok. Bp 
对 于 操控 器 和 它 的 接口 (第 4 篇 ) 来 说 尤为 重要 。 
这 里 阐述 的 基本 传 感 和 估计 技术 已 经 充分 发 展 ， 而 且 
已 经 应 用 到 特殊 的 传 感 系统 中 ， 这 将 会 在 第 3 篇 进行 
介绍 。 运 动 规划 在 操控 器 〈 第 4 篇 ) 和 移动 式 与 分 
布 式 机 器 人 系统 〈 第 5 篇 ) 中 是 一 个 很 重要 的 方面 。 

机 器 人 的 系统 构架 和 人 工 智 能 的 推理 理论 在 运动 
学 、 机 械 动 力 设计 、 控 制 原理 和 分 布 式 机 器 人 学 
(第 5 篇 ) 、 以 人 为 中 心 和 仿生 机 器 人 学 〈 第 7 篇 ) 
中 起 到 特别 重要 的 作用 。 

了 解 第 1 篇 的 概述 后 ， 我 们 下 面 提供 关于 每 章 的 
简要 概述 。 
第 1 章 运 动 学 ， 提 供 大 量 的 表示 法 和 惯例 来 描述 
在 机 器 人 装置 中 物体 的 运动 。 其 中 包括 旋转 矩阵 、 欧 
拉 角 、 四 元 法 、 齐 次 变换 、 旋 转变 换 、 和 矩阵 指数 参数 
化 、 普 吕 克 坐标 系 。 提 供 了 所 有 普通 的 关节 类 型 的 运 
动 学 表示 方法 ， 同 时 也 提供 修正 形式 的 D-H 参数 法 。 
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这 些 坐标 表示 法 会 被 应 用 到 计算 工作 空间 、 正 运动 学 
或 者 道 运动 学 、 正 瞬时 运动 学 和 逆 瞬 时 运动 学 、 雅 可 
比 行列 式 和 静态 扭转 传动 中 。 

第 2 章 动力 学 ， 介 绍 动力 学 方程 ， 从 而 可 以 得 出 
区 动 和 作用 在 机 器 人 上 接触 力 的 关系 ， 以 及 力 所 导 致 
和 加 速度 运动 轨迹 。 提 供 了 有 效 的 算法 ， 以 此 来 计算 
要 的 运动 学 问题 ， 包 括 道 动 力学 、 正 动力 学 、 关 节 
空间 惯性 矩阵 和 操作 空间 惯性 矩阵 。 这 种 算法 可 能 会 
被 应 用 到 固定 基 座机 器 人 、 移 动机 器 人 、 并 联机 器 人 
中 。 这 种 简洁 的 表达 式 算 法 是 由 于 需要 用 六 维 空间 运 
动 来 描述 刚体 的 速度 、 加 速度 、 惯 性 等 。 

第 3 章 机 构 与 驱动 ， 聚 焦 于 机 器 人 系统 的 设计 和 
构建 的 指导 原则 。 用 运动 学 方程 和 雅 可 比 行列 式 来 描 
述 工作 空间 和 机 械 性 能 优点 ， 并 以 此 来 指导 机 器 人 尺 
才 和 关节 布置 。 串 联机 器 人 或 相似 类 型 的 机 器 人 都 可 
以 处 理 。 设 计 关 节 结 构 和 选择 驱动 顺 、 传 动机 构 要 考 
虑 到 实际 情况 。 还 介绍 了 速度 、 加 速度 、 可 重复 性 及 
其 他 措施 方面 的 机 器 人 性 能 。 

第 4 章 传 感 与 估计 ， 简 要 介绍 了 在 机 器 人 学 中 具 
有 广泛 适用 性 的 传 感 理论 与 估计 技术 。 这 些 理 论 和 技 
术 提 供 有 关 环境 和 机 器 人 系统 状态 的 信息 。 主 要 按照 
传 感 、 特 征 提 取 、 数 据 融 合 、 参 数 估计 和 模型 集成 等 
来 介绍 。 介 绍 和 描述 了 多 种 常规 传 感 形 式 。 在 线性 和 
非 线 性 理论 系统 中 讨论 了 估计 理论 ， 包 括 统计 估计 、 
卡尔 曼 滤波 顺和 基于 采样 的 理论 。 也 介绍 了 一 些 常 用 
的 估计 表示 法 。 

第 5 章 运动 规划 ， 在 充满 了 障碍 物 的 地 方 ， 对 于 
复杂 的 机 体 ， 完 成 从 出 发 点 到 目的 地 的 过 程 中 不 碰撞 
任何 物体 是 机 器 人 的 基本 任务 。 介 绍 基本 的 路 线 设计 
难题 (钢琴 搬运 者 难题 )， 这 一 章 仅 集中 于 基于 样品 
的 规划 理论 ， 因 为 它 具 有 非常 广泛 的 适用 性 。 根 据 各 
种 不 同 的 限制 条 件 进 行规 划 是 一 种 续 密 的 行为 ， 而 且 
对 于 轮 式 移 动机 器 人 也 是 非常 重要 的 。 相 对 于 基本 的 
运动 规划 而 言 ， 扩 展 的 、 变 化 的 ， 也 可 以 说 更 加 高 级 
的 问题 将 会 在 章节 的 末尾 讨论 。 

第 6 章 运动 控制 ， 集 中 于 精确 的 机 器 人 操作 器 的 
运动 控制 。 面 临 的 主要 挑战 是 非 线性 耦合 动力 学 和 组 
织 的 或 非 组 织 的 不 确定 因素 。 这 一 章 讨论 的 主题 用 于 
解决 复杂 的 动力 学 问题 ,包括 从 独立 关节 控制 和 PID 
(比例 -积分 -微分 ) 控制 到 计算 转 矩 控制 。 适 应 性 和 
强健 控制 用 于 人 处 理 系 统 不 确定 性 问题 。 这 章 最 后 以 可 
重复 性 运动 的 数字 化 实现 和 认 知 控制 的 一 些 实际 思考 
作为 结束 。 

第 7 童 力 控 制 ， 集 中 于 机 器 人 系统 和 它 的 外 在 环 
境 的 相互 作用 力 的 控制 。 这 一 章 将 相互 作用 力 的 控制 
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分 成 两 类 : 间接 和 直接 的 力 的 控制 。 它 们 的 区 别 在 于 者 一 一 组 件 的 主要 类 型 和 相互 连接 这 些 组 件 的 常用 
完成 力 的 控制 不 带 有 (间接) 或 带 有 (直接 ) 明确 RR, 

终止 力 的 反馈 环 路 。 阻 抗 控 制 和 混合 力 或 者 运动 控制 第 9 章 机 絮 人 智能 推理 方法 ， 描 述 了 目前 在 基于 
分 别 是 这 两 种 控制 类 型 的 代表 。 相 互 作用 任务 的 基本 ” 符号 的 推理 理论 和 应 用 方面 的 人 工 智 能 的 工艺 水 平 ， 
问题 的 模型 被 表达 出 来 ， 它 为 力 控制 策略 黄 定 基础 。 这 方面 的 人 工 智能 被 认为 是 和 机 器 人 学 最 为 相关 的 。 
第 8 章 机 器 人 体系 结构 与 程序 设计 ， 介 绍 软件 架 ”因为 动态 的 和 部 分 未 知 的 工作 环境 ， 所 以 在 移动 机 器 
构 和 用 于 发 展 机 融 人 系统 的 辅助 性 程序 设计 工具 和 环 。 人 上 推理 被 认为 是 极 具 挑战 性 的 。 这 一 童 描述 了 知识 
境 。 机 器 人 架构 有 特殊 的 要 求 ， 这 是 不 确定 、 动 态 的 表达 和 推断 ,覆盖 了 逻辑 学 和 概率 论 的 方法 。 除 了 推 
环境 和 机 器 人 相互 作用 的 必然 要 求 。 这 一 章 讨论 分 层 。” 理 理论 ， 这 一 章 还 考虑 了 遗传 推理 应 用 ， 即 动作 规划 
机 器 人 控制 构架 一 一 行为 控制 、 执 行 领导 和 任务 计划 与 机 器 人 学 习 。 
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运动 学 涉及 机 器 人 机 构 中 物体 的 运动 ， 但 并 不 
考虑 引起 运动 的 力 / 力 窍 。 由 于 机 器 人 机 构 是 为 运 
动 而 精心 设计 的 ， 所 以 运动 学 是 机 器 人 的 设计 、 分 
析 、 控 制 和 仿真 的 基础 。 机 器 人 学 领域 的 学 者 一 直 
致力 于 运用 位 置 、 姿 态 以 及 它们 对 时 间 导 数 的 不 同 
表示 方式 ,解决 基本 的 运动 学 问题 。 

本 章 将 给 出 物体 在 空间 中 的 位 置 和 方位 的 最 有 
j 的 表示 方式 、 机 需 人 机 构 中 最 常见 的 关节 运动 
学 ， 以 及 表示 机 器 人 机 构 几 何 学 的 常用 约定 。 这 些 
表示 工具 将 被 用 于 计算 机 器 人 机 构 的 工作 空间 、 正 
向 和 逆向 运动 学 、 正 向 和 逆向 微分 运动 学 、 静 力 变 
换 。 简 而 言 之 ， 本 章 将 重点 放 在 用 于 开 链 机 构 的 
算法 。 

本 章 的 目的 是 为 读者 以 列表 形式 提供 一 系列 通 
j 工 具 ， 并 简要 介绍 用 于 解决 特定 机 器 人 机 构 运 动 
学 问题 的 主要 算法 。 
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1.1 概述 


除非 明确 次 明 ， 和 否则 ， 机 器 人 机 构 是 指 由 关节 连 
接 的 刚体 所 构成 的 系统 。 刚 体 在 空间 的 位 置 和 姿态 统 
称 为 位 姿 。 因此， 机 絮 人 运动 学 描述 的 是 位 姿 、 速 
度 、 加 速度 ， 以 及 构成 机 构 的 物体 位 姿 的 高 阶 导 数 。 
由 于 运动 学 不 涉及 引起 运动 的 力 / 力 和 矩 ， 本 章 重点 讨 
论 位 姿 和 速度 。 这 些 介绍 是 动力 学 (第 2 E), ieu 
规划 (第 5 章 ) 、 运 动 控制 (第 6 章 ) 算法 的 基础 。 

在 物体 连接 的 众多 可 能 拓扑 中 ， 有 两 种 拓扑 在 机 
只 人 中 特别 重要 ,分别 是 串联 链 式 机 构 和 全 并 联机 
构 。 若 刚体 系统 中 的 每 一 个 中 间 刚 体 均 与 其 他 两 个 刚 
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体 连接 ， 第 一 个 和 最 后 一 个 刚体 只 与 一 个 刚体 连接 ， 
则 该 刚体 系统 为 串联 链 式 机 构 。 若 刚体 系统 中 的 两 个 
刚体 通过 多 个 关节 连接 ， 则 该 刚体 系统 为 全 并 联机 
构 。 实 际 上 ， 每 一 个 关节 本 身 就 是 一 个 串联 链 。 本 章 
主要 着 眼 于 用 于 串联 链 的 算法 ， 并 联机 构 将 在 第 12 
章 详 细 讨论 。 


1.2 位 置 与 姿态 表示 


在 空间 上 ， 刚 体 运动 学 可 以 看 做 是 物体 位 姿 不 同 
表示 方法 的 对 比 研 究 。 平 移 和 旋转 ， 两 者 结合 称 为 刚 
体 的 偏 黎 ， 也 采用 这 些 表 示 进 行 表达 。 没 有 哪 一 种 方 
法 对 所 有 的 问题 都 是 最 优 的 ， 每 一 种 方法 对 解决 不 同 
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的 问题 各 有 优势 。 向 。 例 如 ， 一 个 物体 在 圆 轨道 上 绕 一 个 过 圆心 的 轴 旋 

在 欧 几 里 德 空间 中 ， 对 一 个 物体 定位 的 最 少 坐 标 ” 转 ， 在 旋转 轴 上 的 任 一 点 是 物体 上 保持 初始 位 置 的 

数量 为 6。 许 多 空 GERE a ied 点 。 与 表示 位 置 的 平移 一 样 ， 任 何 表示 姿态 的 方法 均 
中 的 坐标 之 间 存 在 辅助 关系 。 独 立 的 辅助 关系 数量 为 ”可 表示 旋转 ， 反 之 亦 然 。 


6， 它 不 同 于 坐标 数量 。 
本 章 及 后 续 章 节 频 繁 使 用 参考 坐标 系 或 简称 坐标 
系 。 一 个 参考 坐标 系 i 由 坐标 原点 和 3 个 相互 正 交 的 
基 矢 量 构成 ， 固 定 于 特定 的 物体 上 。 坐 标 原点 记 为 
0 ， 基 矢量 记 为 (R 六 2)。 一 个 物体 的 位 姿 总 是 
UE 故 它 可 以 表示 为 一 个 坐 


1. 旋转 矩阵 

坐标 系 i 相 对 于 坐标 系 j 的 姿态 可 以 利用 基 矢 量 
(4, y; £) 在 基 矢 量 (x, y, z) 中 形成 的 矢量 表 
Ro ERRER Cx, /7y, 72), BUG x33B 
阵 ， 称 为 旋转 矩阵 。 IR, 中 的 元 素 是 两 个 坐标 系 基 矢 


标 系 相对 于 男 一 个 坐标 系 的 位 姿 。 类 似 地 ， 一 个 刚体 
ATLA aR HIS 其 中 一 个 
刚体 可 以 看 做 是 运动 的 ， 另 一 个 刚体 看 做 是 固定 的 。 
这 表示 观测 者 位 于 固定 坐标 系 下 的 固定 位 置 ， 并 不 存 
在 任何 绝对 固定 的 坐标 系 。 


1.2.1 位 置 与 平移 


AR ZR i 的 原点 相对 于 坐标 系 / 的 位 置 可 以 表示 
为 3 x1 的 矢量 
ip; 
ip; = ip 
p; 


矢量 中 的 元 素 是 0; 在 坐标 系 j 中 的 笛 卡 儿 坐 标 ， 
A tp, 在 相应 坐标 轴 上 的 投影 。 该 矢量 中 的 元 
素 也 可 以 表示 为 O, 在 坐标 系 / 中 的 球面 或 柱 面 坐 
标 ， 以 有 利于 分 析 具 有 球 关 节 或 柱 关节 的 机 器 人 
机 构 。 

平移 是 指 这 样 的 偏 移 ， 刚 体 上 的 任何 一 点 不 再 处 
于 其 初始 位 置 ， 刚 体 上 的 所 有 直线 平行 于 其 初始 方向 
(点 和 直线 不 是 必须 包含 在 某 刚体 的 边界 上 ， 然 而 ， 
空间 中 的 任何 点 和 直线 都 可 以 被 认为 严格 固定 在 物体 
上 ) 。 一 个 物体 在 空间 的 平移 ， 可 以 表示 为 平移 前 后 
的 位 置 。 相 反 ， 一 个 物体 的 位 置 可 以 表示 为 平移 ， 即 
从 一 个 固定 于 物体 的 坐标 系 与 固定 坐标 系 一 致 的 位 
置 ， 移 动 到 当前 的 固定 于 物体 的 坐标 系 与 固定 坐标 系 


该 
是 


量 的 点 积 


ZNO 


"T 
Ki KX) Yik Zi %; 

pee NR ae See ee ae 

R;o|x;ty; Vi Y; Zo (1.1) 
~ sa 
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Miren 是 单位 矢量 ， 而 且 任何 两 个 单位 矢量 的 点 
积 是 其 夹 角 的 余弦 ， 所 以 上 述 元 素 被 称 为 方向 余弦 。 


一 个 基本 旋转 是 坐标 系 i 绕 z 轴 旋转 角度 0 形成 
的 矩阵 
cosü -sing 0 
R,(0) =| sinf cos ] (1.2) 
0 0 1 
4 5 rief e o 形成 的 矩阵 
cosó 0 sing 
R,(0)- 0 1 0 | (1.3) 
—sinü 0  cos0 
Ze x lUi te fü BE 9 形成 的 矩阵 
1 0 0 
R,(0)-|0 cos0 € (1.4) 
0 sinf cosé 
旋转 矩阵 及 , 含有 9 个 元 素 ， 其 中 只 有 3 个 参数 
是 定义 物体 在 空间 的 姿态 所 需要 的 。 因 此 ， 旋 转 和 矩 


阵 的 元 素 中 具有 6 个 辅助 关系 。 因 为 坐标 系 i 的 基 
矢量 是 相互 正 交 的 ， 坐 标 系 7 的 基 矢 量 也 是 相互 正 
交 的 ， 所 以 由 这 些 正 交 矢量 的 点 积 形成 的 于 ;的 列 矢 


不 一 致 的 位 置 。 因 此 ， 任 何 位 置 的 表示 方法 均 可 用 于 
表示 平移 ， 反 之 亦 然 。 


1.2.2 姿态 与 旋转 


与 位 置 相 比 ， 姿 态 的 表示 方法 更 加 丰富 。 本 节 并 
不 罗列 所 有 的 姿态 表示 方法 ， 仪 给 出 机 器 人 中 最 常用 
的 姿态 表示 方法 。 
旋转 是 指 这 样 的 偏 移 ， 刚 体 上 至 少 有 一 点 处 于 其 
初始 位 置 ， 不 是 刚体 上 的 所 有 直线 平行 于 其 初始 方 


量 也 是 正 交 的 。 由 正 交 矢 量 构成 的 矩阵 称 为 正 交 矩 
阵 ， 它 具有 一 个 特性 ， 即 其 逆 矩 阵 是 其 转 置 矩 阵 。 
该 特性 决定 了 其 6 个 辅助 关系 ， 其 中 3 个 关系 为 列 

量具 有 单位 长 度 ， 另 外 3 个 关系 为 列 矢 量 相互 正 
交 。 另 外 ， 旋 转 矩 阵 的 正 交 性 对 于 逆序 坐标 系 依然 成 
立 。 坐 标 系 j 相 对 于 坐标 系 i 的 姿态 为 旋转 矩阵 'R,， 
显然 ,'R; ITRE R, 的 列 矢 量 。 旋 转 和 矩阵 通过 
简单 的 矩阵 相 乘 相 结 合 ， 可 以 获得 坐标 系 i 相 对 于 华 
标 系 上 的 姿态 
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"R, ="R; İR; 


总 之 , 'R, 是 一 个 将 坐标 系 中 表示 的 矢量 转换 为 


> 


坐标 系 7 中 表示 的 矢量 的 旋转 矩阵 ， 它 提供 坐标 系 ; 


相对 于 坐标 系 7 的 姿态 


态 表 示 的 转换 。 


C 示 ， 也 可 表示 为 坐标 系 i 到 
坐标 系 7 的 旋转 。 表 1.1 列 出 了 本 节 中 其 他 姿态 表示 
的 等 价 变换 和 矩阵， 表 1. 2 给 出 了 从 旋转 矩阵 到 其 他 姿 


表 1.1 其 他 姿态 表示 的 等 价 变换 矩阵 ， 


缩写 c,=cos0, s,=sin0, v,=1-cosd 


Z-Y-X KAA (a, B, y): 


CaCB Caspsy mE 


IR; =] Sag Saspsy t+ Cyl, 


3g Cpsy Cpe 


CoSply Sas 


y 


y 


SqSply = Caly 


X-Y-Z 固定 角 (v, 0, p): 


Calo Cosgsy ^ SgCcy Cosocy + Sgsy 
j = = 
R; =| Soco Sgsgsy tcgcy Sgsocy — blu 
—$g CoSy Coly 
^ 
- 轴 Ow: 
2 ) 
WiUg 十 cb W, W Vg — W,Sg W,W Vg  W,8p 
j = " Ra = 
R; =| w,W,vg + w,se WyUg + Cp W,WVg — Wasg 
W, W, Vg — Wsg Wwvg t W,Sg w? Ug * Cg 


单位 四 元 数 (eo, 8. &, 


1 -2(e +6) 


e)": 


IR, =| 2(6465 + £983) 


2( £183 — 6963) 


2(2s122 — £983) 
1 -2(e? +83) 


2( E383 * &g&i) 


2(&8,85 + &y&3) 
2(&585 一 2021) 


1 -2(e? +e?) 


表 1.2 从 旋转 矩阵 到 其 他 姿态 表示 的 转换 


旋转 矩阵 : 
hy TU. fis 
IR, =) mm T3 


Z-Y-X RALA (a, B, y): 


B=Atan2( -mi，Vm +1751) 


Ty Tu ) 
cosB” cosB 


y = Atan2 (2 : ie ) 
cosB' cosB 


X-Y-Z 固定 


(2) 


(hb, 0, p): 


0 = Atan2( 一 了 入 Jf, tra) 


Tu 


= Atan2 (25. 
cos 


T33 
Atan2 | — 
w = Atar (= "E 


n 轴 Ow : 


0 = arccos 
arceos( 2 


cos 


cos 


) 
) 


Tii +722 +133 =) 


单位 四 元 数 (e0, 6i, 


22， e)": 


1 
E BU Jl try +ra +1733 


T4) — Tas 


&- 
1 
48 


T3 — 731 


f= 
2 48g 


Tj 一 712 


B= 
3 
48g 


2. 欧 拉 角 
作为 一 
姿态 可 表示 为 3 个 角 
些 角 被 称 为 欧 拉 角 ， 
在 这 种 方式 1 
转 ， 旋 转 的 | 


个 最 小 表示 ， 坐 标 系 


i 相对 于 坐标 系 7 的 
(a, B, y) 的 一 个 矢量 。 这 
每 个 角 代 表 绕 一 个 轴 的 旋转 。 


下 ， 每 个 轴 的 相继 旋转 取决 于 以 前 的 旋 
顺序 需 与 定义 姿态 的 3 个 角 的 顺 
例如 ， 本 手册 使 用 符号 


FRB, 
(a, B, y) 表示 Z-Y-X KK 


拉 角 ， 其 含义 如 下 : 在 初始 状态 下 运动 坐标 系 i 与 


国定 坐标 系 / 重合 


, a 是 坐标 系 守 的 2: 轴 的 广 
是 坐标 系 i 的 7》 轴 的 旋转 ，y 是 
转 。 其 等 价 变换 矩阵 'R, 见 表 1. 1。 


EFE, B 
坐标 系 i 的 * 轴 的 旋 
Z-Y-Z fl Z-X-Z 


Wehr fg ie 12 种 其 他 顺序 旋转 中 的 另外 两 种 常用 的 表 


示 方 式 。 


无 论 旋转 顺序 如 何 ， 当 第 一 次 和 最 后 一 次 旋转 在 


同一 个 轴 上 时 ， 欧 拉 角 姿态 表示 会 存在 奇异 问题 。 由 


表 1.2 可 知 ， 当 B=+ 上 90" 时 ， 角 a 和 难以 区 分 (对 


T Z-Y-Z fli Z- X- Z Echt fa, 


当 第 2 次 旋转 为 0 或 


180°* 时 ， 同 样 存在 奇异 问题 )。 这 就 出 现 了 一 个 与 角 


速度 矢量 ( 即 欧 拉 角 


它 会 在 某 种 程度 上 限制 欧 拉 角 在 机 器 人 系统 


MH, Z-Y-X WRF 


对 时 间 的 导数 ) 相关 的 问题 
建 模 上 的 


角速度 关系 为 
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g — sinB 0 1 \ { @x 
B =| cosBsiny cosy 0| |w， 
cosBcosy -sing 0/ (o, 


3. 固定 角 

坐标 系 i 相 对 于 坐标 系 j 的 姿态 也 可 表示 为 另外 
3 个 角 的 一 个 矢量 ， 其 中 每 个 角 代 表 绕 固定 坐标 系 一 
个 轴 的 旋转 。 相 应 地 ， 这 些 角 被 称 为 固定 角 ， 旋 转 的 
顺序 需 与 重新 定义 姿态 的 3 个 角 的 顺序 一 致 。 其 中 ， 
定义 为 (Y, 0, 6) B X-Y-Z 固定 角 ， 是 在 12 种 可 
能 的 旋转 顺序 中 常用 的 一 种 。 运 动 坐 标 系 i 与 固定 坐 
标 系 j 在 初始 状态 下 重合 ,yw 是 绕 固 定 轴 世 的 旋转 ， 
称 为 偏转 ; 9 是 绕 固 定 轴 7》 轴 的 旋转 ， 称 为 俯仰 ; 
中 是 绕 固定 轴 2 轴 的 旋转 ， 称 为 横 滚 。 

其 旋转 的 顺序 根据 这 些 角 定 义 。 每 个 角 代 表 绕 
一 个 轴 的 旋转 。 比 较 表 1.1 中 的 相应 等 价 旋转 变换 
和 表 1.2 中 的 相应 转换 ， 可 以 发 现 ，X-Y-2Z 固定 角 
5 Z-Y-X 欧 拉 角 是 等 价 的 , mH a=b, B=0, y= 
小 。 上 述 结果 表明 ， 绕 固定 坐标 系 的 3 个 轴 旋 转 定义 
的 姿态 ， 与 以 相反 顺序 绕 运动 坐标 系 的 3 个 轴 旋 转 定 
义 的 姿态 相同 。 同 样 ， 所 有 方式 的 固定 角 表 示 的 姿态 
也 像 欧 拉 角 表示 的 姿态 那样 ， 具 有 奇异 问题 。 固 定 角 
对 时 间 的 导数 与 角速度 矢量 之 间 的 关系 ， 也 类 似 于 欧 
拉 角 对 时 间 的 导数 与 角速度 矢量 之 间 的 关系 。 

4. 角 - 轴 

一 个 角度 0 与 一 个 单位 矢量 w 相 结 合 ， 也 可 以 表 
示 坐 标 系 i 相 对 于 坐标 系 j 的 姿态 。 在 这 种 情况 下 ， 
坐标 系 i 绕 相对 于 坐标 系 j 定 义 的 矢量 w= (w， w, 
w.) 旋转 角度 6。 矢量 w 为 有 限 旋 转 的 等 价 轴 。 角 


I 


轴 表示 方式 常 记 作 Ow (Ow, Ow, Ow)", ffi- Hh 
表示 方式 因 采 用 4 个 参数 ， 故 具有 一 个 元 余 参 数 。 


辅助 关系 是 矢量 w 为 单位 矢量 ， 即 其 模 长 为 1。 即 
使 存在 该 辅助 关系 ， 角 - 轴 表 示 方 式 也 不 是 唯一 的 ， 
这 是 因为 绕 矢 量 -ww 旋转 -9 与 绕 矢 量 w 旋转 0 是 等 
价 的 。 表 1.3 给 出 了 角 - 轴 表示 与 单位 四 元 数 的 姿态 
表示 之 间 的 转换 。 这 两 种 表示 与 欧 拉 角 或 固定 角 之 
间 的 转换 见 表 1.2， 与 等 价 旋转 矩阵 之 间 的 转换 见 
表 1.1。 利 用 密切 相关 的 四 元 数 表 示 ， 更 容易 处 理 
速度 关系 。 

5. 四 元 数 

四 元 数 表 示 姿 态 起 源 于 Hamilton", iE iit m 
Gibbs!" ?! ffl Grassmann''*! 改进 为 更 简化 的 矢量 ， 它 
对 于 解决 机 器 人 学 中 的 矢量 /矩阵 表示 的 奇异 问题 非 


常 有 用 。 四 元 数 不 像 欧 拉 角 那 样 具有 奇异 问题 。 


R13 和 角 - 轴 表示 与 单位 四 元 数 的 
姿态 表示 之 间 的 转换 


- 轴 08 到 单位 四 元 数 (ey, e, 


83, 83)": 


= 0 
& = cos — 


2 


0. 68 
€4 = w.sin DE 


单位 四 元 数 (€, €15 &», £3). 到 1- 4H Ow: 


0 = 2arccoséy 


£1 


四 元 数 定义 为 如 下 形式 ; 
£-6&yt&jit&ejt&ek 
XP, 元素 6. 6. 6, 6; 是 比例 因子 ， 有 时 也 称 
为 欧 拉 参数 ;i、j、% 是 算 子 。 这 些 算 子 的 定义 符合 
如 下 规则 . 


ü-j-kk- -1, j-k, jk=i, 

ki=j, jiz -k, i= -i, ik= -j 
两 个 四 元 数 相 加 时 ， 将 对 应 的 元 素 分 别 相 加 。 
因此 ， 算 子 的 作用 像 分 离 器 。 对 于 加 法 ， 空 元 素 为 
四 元 数 0 =0 +0i+07+0k。 四 元 数 的 相 加 符合 结合 
律 、 交 换 律 和 分 配 律 。 对 于 乘法 ， 空 元 素 为 四 元 数 
7T=1+0+0+0。 对 于 任意 四 元 数 s， 有 7e =e MK 
立 。 四 元 数 的 相 乘 符合 结合 律 和 分 配 律 ， 但 不 符合 交 
换 律 。 由 算 子 规则 和 加 法 ， 得 到 四 元 数 的 相 乘 形式 ; 


ab -ajb, — a,b, — a,b, — a,b, + 


(ab, +a, by + a,b, —a4b,)i (1.6) 
(agb, + a,b, a,b, — a,b; )j 
(agb, t 3b) + a,b, — a,b, ) k 


定义 四 元 数 的 补 
£-& -&ji-&j-e&k 
因此 ， 


E E E 212 
EE = €€=6) +6, t£, t €i 
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一 个 单位 四 元 数 定义 为 ss =1。 通常 ，s, 称 为 四 元 数 
的 比例 部 分 ，(s， 6) 6e) 称 为 矢量 部 分 。 

单位 四 元 数 用 于 描述 姿态 ， 其 单位 模 长 为 用 于 解决 
宛 余 坐标 (4 坐标 ) 的 辅助 关系 。 以 四 元 数 定义 的 矢量 
We, =0 的 四 元 数 。 因 此 ,矢量 p =(p, p, p)" 可 以 
表示 为 四 元 数 p = p.i +p, j +p,ko 对 于 任意 单位 四 元 数 
E， 操 作 gpz 执 行 的 是 拓 量 p 绕 (e, e e)" 方向 的 
旋转 ， 这 可 以 通过 展开 epe 并 比较 表 1. 1 中 的 等 价 旋 
转 和 矩阵 验证 。 如 表 1.3 所 示 ， 单 位 四 元 数 与 角 - 轴 姿 
态 表 示 密 切 相 关 ，s 代表 了 转角 ， 而 el e e IX 
表 了 转轴 。 

对 于 速度 分 析 ， 四 元 数 对 时 间 的 导数 可 与 角速度 
矢量 建立 联系 : 


Eo -€; -& -£ 
w, 
g E 一 2， 
wa Ne dell 2 i o, (1.7) 
E, 2 7463 £o £i 
o. 
a 8, -él & 
当 一 个 单位 四 元 数 仅 表 示 一 个 物体 的 姿态 时 ， 四 
元 数 可 以 被 二 元 化 "| 为 一 个 描述 物体 空间 位 置 和 


姿态 的 代数 式 。 其 他 复合 式 表示 将 在 后 面 介绍 。 
1.2.3 FREF 


前 面 分 别 介绍 了 位 置 和 姿态 的 表示 。 利 用 齐 次 变 
换 ， 位置 矢量 和 旋转 矩阵 可 以 用 更 加 简洁 的 方式 结合 
在 一 起 。 如 果 i 坐标 系 相对 于 j 坐标 系 的 位 置 和 姿态 
已 知 ， 那 么 ;坐标 系 中 的 任 一 矢量 7 也 可 以 表示 为 j 
坐标 系 中 的 矢量 。 利 用 1.2.1 节 中 的 符号 ， 坐 标 系 ; 
的 原点 相对 于 坐标 系 j 的 位 置 可 表示 为 矢量 'p; = 
Cpt ‘pt /人 p;)"。 利 用 1.2.2 节 中 的 符号 ， 坐标 系 i 
相对 于 坐标 系 7 BOXES IR; 表示 。 这 样 ， 


ir ZiR/r p, (1. 8) 
该 方程 可 重 写 为 
OQ we 
1) (o jJU 
其 中 
BE d (1.10) 
o" 1 


是 4x4 的 齐 次 变换 矩阵 。(7 1)" Cr 1) 是 位 
BARE r Mr 的 齐 次 表示 。 和 矩阵 7, 将 坐标 系 守 中 的 
矢量 变换 为 坐标 系 j PRE, HERET Ae 
系 j 中 的 矢量 变换 为 坐标 系 i 中 的 矢量 。 


— iR? IR" dy, 
IT’ ='T,=| | (1.11) 
0” 1 


4 x4 FREMA MEY Gs TE R J ff] PAY SB ER , 
正如 3 x3 ADHERE, DIC, A'T, =*T, /7, 成 
立 。 由 于 矩阵 乘法 不 能 交换 ， 所 以 其 顺序 非常 重要 。 

绕 一 个 轴 的 纯 旋转 的 齐 次 变换 有 时 记 为 Rots F 
ie, Zell 2 jere o 角度 记 为 


cosü -sinf 0 0 
Rot, 0) sind | cos 0 0 (1.12) 
(2,0) = . 
TS 0 0 10 


0 0 0 1 
类 似 地 ， 沿 一 个 轴 的 纯 平移 有 时 记 为 Trans。 于 
E, YAN EH d 记 为 


1 0 0 d 

Trans(&, d) = een (1. 13) 
0.0 1 0 
0 0 0 1 


当 希 望 符号 简洁 时 ， 当 编程 的 容易 程度 是 最 需要 
考虑 的 因素 时 ， 齐 次 变换 是 特别 具有 吸引 力 的 。 但 
是 ,由 于 它 引 入 了 大 量 含 有 0 和 1 的 附加 乘法 运算 ， 
所 以 它 并 不 是 一 种 计算 效率 好 的 表示 。 尽 管 齐 次 变换 
和 矩阵 具有 16 个 元 素 , 但 有 4 个 元 素 被 定义 为 0 或 1， 
剩余 的 元 素 则 包括 一 个 旋转 矩阵 和 一 个 位 置 矢量 。 因 
此 ， 真 正 的 元 余 坐 标 来 自 旋转 矩阵 部 分 ， 相 应 的 辅助 
关系 也 与 旋转 矩阵 有 关 。 


1.2.4 旋 量 变换 


式 (1.8) 的 变换 可 以 看 作 是 坐标 系 i MERR j 
之 间 旋 转 和 偏 移 的 复合 变换 。 从 坐标 系 i 变换 到 坐标 
系 7 时 ,应 先进 行 旋转 再 进行 偏 黎 ， 反 之 亦 然 。 再 
者 ， 除 纯 平移 之 外 ， 两 个 坐标 系 之 间 的 偏 移 可 以 表示 
为 绕 特 定 直 线 的 旋转 和 沿 该 直线 的 纯 平 移 。 

1. Chasles 定理 

Chirikjian 和 Kyatkin' ^ * 给 出 的 Chasles 定理 ， 由 
两 部 分 构成 。 

第 一 部 分 为 : 物体 在 空间 中 的 任 一 偏 移 可 以 认为 
由 平移 和 旋转 组 成 ， 即 指定 点 从 初始 点 到 终点 的 纯 平 
移 ， 以 及 物体 绕 指 定点 使 之 到 达到 终点 姿态 的 旋转 。 
第 二 部 分 为 : 物体 在 空间 中 的 任 一 偏 移 可 以 表示 
为 绕 空间 特定 直线 的 旋转 和 沿 该 直线 的 纯 平 移 。 该 直 
线 称 为 旋 量 轴 ， 是 Chasles 定理 的 第 二 个 结论 。 

Chasles 定理 的 第 一 部 分 是 显而易见 的 。 在 欧 几 
里 德 空 间 中 物体 上 的 任意 一 个 指定 点 ， 可 以 被 从 一 个 
给 定 的 初始 位 置 转移 到 一 个 给 定 的 终点 位 置 。 更 进 一 
步 ， 物 体 上 的 所 有 点 作 同 样 的 偏 移 ， 则 物体 进行 了 平 
移 ， 指 定点 也 就 从 其 初始 位 置 移 动 到 其 终点 位 置 。 然 
后 ， 物 体 可 绕 指定 点 旋转 到 任意 给 定 的 终点 姿态 。 
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Chasles 定理 的 第 二 部 分 依赖 于 空间 偏 移 的 表示 ， 
需要 进行 更 为 复杂 的 论证 。 欧 拉 的 一 个 预备 定理 可 以 
更 加 明确 地 说 明 物 体 的 旋转 : 物体 保持 一 点 固定 的 任 
何 偏 移 ， 等 价 于 物体 绕 通 过 该 固定 点 的 一 个 特定 轴 的 
旋转 。 几 何 上 ， 在 运动 物体 的 三 个 嵌入 点 中 ， 若 有 一 
点 在 旋转 时 是 固定 点 ， 则 其 他 两 点 中 的 任何 一 点 将 有 
初始 位 置 和 终点 位 置 。 连 接 其 初始 位 置 和 终点 位 置 形 
成 一 条 直线 段 ， 该 直线 段 的 中 徘 面 必 然 通 过 上 述 固定 
点 。 在 一 个 中 垂 面 上 的 任意 一 条 直线 均 可 能 是 含有 相 
应 点 的 初始 位 置 和 终点 位 置 的 旋转 的 旋转 轴 。 因 此 ， 
两 个 中 垂 面 的 唯一 公共 线 即 为 包含 物体 上 任意 点 的 初 
始 位 置 和 终点 位 置 的 旋转 的 旋转 轴 。 刚 体 的 刚性 条 
件 ， 决 定 了 物体 上 包含 上 述 旋转 轴 直 线 的 所 有 平面 旋 
转 了 相同 的 角度 。 

Wehr dai, XET BR; 描述 的 一 个 刚体 的 任 
意 旋转 ， 存 在 唯一 的 特征 矢量 使 得 


iRw=w 


(1.14) 
RP, w 是 一 个 平行 于 旋转 轴 的 单位 矢量 。 该 表达 式 
说 明 , IR, 有 一 个 单位 特征 矢量 对 应 于 特征 矢量 w 
剩余 的 两 个 特征 矢量 为 cosg + isind, HEP i 是 复数 操 
作 符 ,9 是 物体 绕 旋 转轴 的 旋转 角 。 

结合 Chasles 定理 的 第 一 部 分 和 欧 拉 定理 ， 
通用 的 空间 偏 移 可 以 表示 为 将 一 个 点 从 初始 位 置 移动 
到 终点 位 置 的 平移 ， 以 及 将 物体 从 初始 姿态 运动 到 终 
点 姿态 的 、 绕 着 通过 该 点 的 特定 轴 的 特定 旋转 。 将 平 
移 分 解 为 沿 轴 向 和 垂直 于 轴 向 的 分 量 ， 则 物体 上 任 一 
点 在 轴 向 上 具有 相同 的 偏 移 量 ， 这 是 因为 旋转 不 影响 
轴 向 分 量 。 向 垂直 于 轴 向 的 平面 投影 ， 则 偏 移 的 运动 
几何 与 该 平面 的 运动 相同 。 正 如 在 平面 上 有 唯一 的 一 
个 点 ， 使 得 物体 能 够 绕 着 该 点 在 两 个 给 定 的 位 置 间 旋 
转 ， 在 投影 平面 上 也 具有 唯一 的 一 个 这 样 的 点 。 正 如 
上 述 定 理 所 言 ， 若 旋转 轴 通 过 该 点 移动 ， 则 绕 该 轴 的 
旋转 形成 的 空间 偏 移 闭 加 了 一 个 沿 该 轴 的 平移 。 

旋转 所 绕 的 直线 称 为 偏 移 的 旋 量 轴 。 线 性 位 移 d 
对 旋转 角 6 的 比率 称 为 旋 量 轴 的 距 n Lt 。 

d=h0 (1.15) 

纯 平移 的 旋 量 轴 不 是 唯一 的 。 由 于 平移 的 旋转 角 为 
0"， 所 以 任何 平行 于 平移 方向 的 直线 均 可 认为 是 旋 量 
轴 ， 其 距 为 无 穷 大 。 

利用 平行 于 旋 量 轴 的 单位 矢量 w 和 在 旋 量 轴 上 
任意 点 的 位 置 矢量 p， 可 最 方便 地 表示 任意 参考 坐标 
系 中 的 旋 量 轴 。 附 加 的 距 h 和 旋转 角 9， 完 整地 定义 
了 第 二 个 坐标 系 相对 于 参考 坐标 系 的 位 姿 。 因 此 ， 共 
有 8 个 坐标 定义 一 个 旋 量变 换 ， 其 中 两 个 为 元 余 的 。 


一 个 


w 的 模 是 一 个 辅助 关系 ,但 通常 没有 第 二 个 辅助 关 
系 。 这 是 由 于 同一 个 旋 量 轴 是 由 在 其 上 面 的 所 有 点 定 
义 的 ,或 者 说 矢量 p 仅 含 有 一 个 自由 坐标 。 


代数 上 ， 旋 量 偏 移 表 示 为 
ip ziR r-p) «dw +p (1.16) 
比较 该 式 与 式 (1.8) , A 
ip, 2 dw + (1,4, -/R,)p (1.17) 


其 中 ,1 .是 3 x3 的 单位 和 矩阵。 方程 的 两 边 与 w 进 
行内 积 ， 容 易 得 到 d 的 表达 式 。 
d 2 wp, (1.18) 
和 矩阵 1 3 Re aT TAS, A (1.17). 不 能 求解 
出 p 的 唯一 值 。 但 由 于 m 可 表示 旋 量 轴 上 的 任意 点 ， 
所 以 情况 并 非 如 此 。p 的 一 个 元 素 可 以 任意 选择 ， 而 
且 利用 分 量 方程 中 的 任意 两 个 方程 ， 可 以 求解 得 到 p 
的 另外 两 个 元 素 。 然 后 ， 在 旋 量 轴 上 的 所 有 其 他 点 可 
以 由 p kw 确定 ， 其 中 居 取 任意 值 。 
表 1.4 给 出 了 旋 量 变换 与 齐 次 变换 之 间 的 转换 关 
系 。 值 得 注意 的 是 ， 旋 量变 换 的 等 价 旋 转 和 矩阵 ， 与 表 
1.1 中 姿态 的 角 - 轴 表示 的 等 价 旋转 矩阵 相同 。 此 外 ， 


在 表 1.4 中 , 利用 矢量 与 旋 量 轴 正 交 (w'p =0) 
这 一 辅助 关系 ， 以 提供 齐 次 变换 到 旋 量 变换 的 唯一 转 


换 。 其 逆 变 换 ， 即 给 定 旋 量 偏 移 求 取 旋 转 矩 阵 'R, 和 
平移 p;， 采 用 Rodrigues 方程 求 取 。 
R14 旋 量 变换 与 齐 次 变换 之 间 的 转换 ， 
缩写 c,-cos0, s, sin, v, =1 — cos 
Je tt Ae e sU 3r UK EIR : 


2 
WwW.vg 十 cb 


Wx207y20 -W Sg WW, Vg uL 


iR. = 4 2 m 
R; = WW, Vo $ WwW.sg WyUg 十 cp W,W V9 Wig 


2 
10 10. Vo Ww,se WW V6 + Wsg W-Ug t Cg 


ip; = (15,4 -İR;)p + how 


齐 次 变换 到 旋 : 


je ht 
e —T93 
l= k 31 | 
We Tig 


0 =sign(1™p,) 


px 


Tg +r2 +733 —1 


e 


arccos ( 


p, 
bu E 
20sin0 
(1545 -İR Vp; 
^. 2(1 - eos0) 
I 
2sing 


^ 
w= 
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物体 上 任 一 点 在 旋 量 偏 移 下 的 初始 和 终点 位 置 如 
图 1.1 所 示 。 


i 与 /坐标 系 一 致 


;初始 


图 1.1 物体 上 任 一 点 在 旋 量 偏 移 下 的 初始 和 终点 位 置 
图 1.1 中 , 'r 是 该 点 相对 于 运动 坐标 系 i 的 位 置 ， 

在 初始 位 置 时 ， 运 动 坐 标 系 与 固定 参考 坐标 系 j 

BG 7r 是 运动 物体 进行 旋 量 偏 移 后 该 点 相对 于 固定 

坐标 系 7 的 位 置 


2. Rodrigues 方程 

给 定 一 个 旋 量 轴 、 物 体 绕 该 轴 的 角 偏 移 和 物体 
沿 该 轴 的 平移 ， 则 物体 上 任 一 点 的 偏 移 可 以 求解 。 
若 将 一 个 矩阵 变换 看 做 是 物体 偏 移 的 描述 ， 则 求解 
旋 量 偏 移 等 价 于 求解 与 给 定 旋 量 偏 移 等 价 的 矩阵 

参见 图 1.1,， 一 个 点 在 旋 量 偏 移 前 后 的 位 置 矢量 
具有 以 下 几何 联系 


ip ='r+dw +sinOw x ((r-p) - 


(1-cos0) (‘r-p) - -r-p) -ww (1.19) 
式 中 ,7 和 /ir 分别 表示 该 点 的 初始 和 终点 位 置 , w 和 p 
表示 旋 量 轴 , 9 和 4 给 出 了 其 偏 移 量 。 该 结果 称 为 
Rodrigues 7; fl^?! ， 可 重 写 为 矩阵 变换 形式 中 
ir =/Rir+'p, (1.20) 
x (1.20) 展开 后 ， 得 到 含有 7 和 的 元 素 的 三 个 线 
性 方程 : 


2 
WV) tC, 


WW Vg — W,Sg — 10,W.Ug + WS, 


j 2 
IR; =| w,w,v, +w,sy W Vg tC, 


3 W, W Vg —W,Sg 


2 
W, W Vg =W, S9 W WVg + WS, WV + Co 


ip, = (1,44 —R,)p + hüw 
式 中 ， 缩 写 Cy — cos0, s, 2 sinÜ, v, 1 — cos, 该 形式 
下 的 旋转 矩阵 及 ; 又 称 为 旋 量 和 矩阵， 这些 方程 给 出 的 


IR, ftp, 的 元 素 称 为 旋 量 参数 。 
纯 平移 是 一 种 特殊 情况 ， 此 时 0 = 0，Rodrigues 
方程 变 为 


ip zip dw (1.21) 


这 种 情况 下 , IR, 21,5, "p, =dw。 
关于 旋 量 理论 的 进一步 信息 参见 参考 文献 
[1. 11-15], 


1.2.5 矩阵 指数 参数 化 


物体 的 位 置 和 姿态 也 可 以 用 指数 表示 为 统一 的 格 
式 。 该 方法 首先 被 引入 纯 旋 转 ， 进 而 扩展 到 刚体 的 运 
动 。 该 方法 的 细节 参见 参考 文献 [1. 16，17] 。 

1. 旋转 的 指数 坐标 

所 有 行列 式 为 1 的 三 阶 正 交 矩阵 的 集合 ， 即 所 有 
旋转 矩阵 R 的 集合 ， 是 和 抢 阵 乘法 操作 的 一 个 群 ， 记 
为 S0(3) CR 。 它 代表 特殊 的 正 交 ， 其 特殊 
之 处 在 于 RR 的 行列 式 为 +1 而 不 是 上 1。 该 旋转 矩阵 
的 集合 符合 一 个 群 的 下 述 4 个 公理 : 

闭 包 性 : RIR, eS0(3) VR,, R,eS0(3), 

一 致 性 : 1,,,R=R1,,,=R VReSO(3), 

可 道 性 : R"eso(3) FER fiüntE—3 V ResO(3), 

结合 性 : (R,R,)R; =R,(R,R,) VR,,R,,R, 


e 50(3), 
在 1.2.2 市 的 角 - 轴 表示 中 ， 姿 态 表示 为 绕 单 位 

矢量 w 旋转 角度 9。 表 1. 1 中 的 等 价 旋转 矩阵 可 以 表 

示 为 指数 形式 
R= 1, 


e 


e 0 ^.2 
0S(w) taps) + 


31800? dis (1.22) 
RP, S (w) RRR 
0 =w, w, 
S(w) =| w, 0 -w, (1.23) 
=w, w, 0 


于 是 ， 上 述 指数 表达 式 将 对 应 于 转轴 的 斜 对 称 和 矩阵 
SQw) 转换 成 了 对 应 于 绕 轴 w 旋转 角度 9 的 正 交 和 矩阵 
R。 更 有 利于 计算 的 ex? 的 闭 式 解 为 
eX? =1 3 +S(W)sing + S(w)'(1-cos0). (1.24) 
(Ow, Ow, 0w.) 的 元 素 与 表 1.2 中 旋转 矩阵 R 的 元 
素 相关 ， 称 为 R 的 指数 坐标 。 
2. 刚体 运动 的 指数 坐标 
正如 在 1.2.3 节 所 指出 的 ， 物 体 的 位 置 和 姿态 可 
以 由 位 置 矢 量 忆 es 民 ”和 旋转 矩阵 好 esSO(3) 表示 。 
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R° 5 S0(3) 的 积 空间 称 为 SE(3) TÉ, SE 代表 特殊 
欧 几 里 德 空间 (special Euclidean) 。 
SE(3) 2| (p,R): peR?, ReSO(3)]| 
-R?xS0(3) 
齐 次 变换 的 集合 符合 一 个 群 的 下 述 4 个 公理 : 


闭 包 性 : T,T, eSE(3) VT,, T, cSE(3); 

一 致 性 : 1,,,T=T 1,,,- T VTeSE(3); 

AWE. T 具有 唯一 的 逆 ， 见 式 (1.11) VT 
e SE(3) ; 

结合 性 : (T,TT, -T,(T,T,) VYT, T, T, 
e SE(3), 


É 1.2.4 Tr E Sg ERR AE BP, LEONE SRI 
用 绕 单 位 矢量 w 定义 的 旋 量 轴 旋转 的 角度 9、 在 旋 
量 轴 上 的 点 p RUE ERE h Ra, HA wp =0。 
其 等 价 的 齐 次 变换 矩阵 ， 见 表 1.4， 也 可 表示 为 指 
数 形式 


oa ÈO? (0)? 
a o apo 


ee 
0 0 
是 单位 斜 对 称 和 矩阵 的 通用 化 表达 式 ， 称 为 扭 


(twist) 。 专 的 扭曲 坐标 记 为 寺 = (w^ v)". oF HOTA 
式 表达 式 为 


(1.25) 


(1.26) 


a 


E : en ‘Gee agi 8s (w xv) A | 
2 " : 

(1.27) 
将 上 述 结果 与 表 1.4 中 的 齐 次 变换 和 旋 量 变换 之 间 的 
转换 相 比 较 ， 有 


v=pxw (1.28) 


H 
h=w'y (1.29) 
于 是 ， 利 用 扭曲 的 指数 形式 ， 将 物体 的 初始 姿态 变换 
到 了 终点 姿态 。 它 给 出 的 是 刚体 的 相对 和 运动。 矢量 
£0 含有 刚体 变换 的 指数 坐标 。 
对 于 旋 量变 换 ， 纯 平移 的 情况 是 独特 的 。 此 时 ， 


EZ = toes id 
o 1 


1.2.6  Plücker 坐标 
间 直 线 最 少 需要 四 个 坐标 。 直 线 的 


(1.30) 


定义 一 条 空 


Plücker 坐标 是 一 个 6 维 矢量 ， 其 元 余数 为 2。 直 线 的 
Plücker 坐标 可 以 认为 是 一 对 3 维 矢量 ， 一 个 平行 于 


HR, -PERERA FÆ, WR u 是 
任 一 平行 于 直线 的 矢量 , p 是 直线 上 任意 点 相对 于 原 


点 的 位 置 ， 则 Pliicker 坐标 (L, M, N, P5 Q, R) 
如 下 : 


(L, M, N) xu ; (P, Q, R)=(pxu) (1.31) 


对 于 简单 定义 的 一 条 直线 ,z 的 幅 值 既 不 唯一 , p 的 
分 量 也 不 平行 于 w。 两 个 辅助 关系 是 隐 仿 的， 它们 将 
Plücker 坐标 集 降低 为 4 个 独立 坐标 。 一 个 辅助 关系 
为 : 两 个 3 维 矢量 的 标量 积 恒 等 于 0。 

LP + MQ + NR=0 (1.32) 
另 一 个 辅助 关系 为 : 所 有 坐标 分 量 同 乘 以 一 个 系数 时 


指定 直线 的 不 变性 。 
(L, M, N, P, Q, R)=(kL, kM, kN, kP, kQ, kR) 

(1.33) 
含有 单位 模 长 的 uw 的 形式 ， 此 时 工 、 


该 关系 也 可 采用 


M 和 为 方向 余弦 。 
本 手册 中 ， 常 用 Pliicker 坐标 表示 速度 ,但 与 直 


线 的 定义 不 同 的 是 ， 两 个 矢量 的 幅 值 不 是 任意 的 。 
由 此 产生 了 von Mises 9 和 Everett! 的 矢量 符 
号 。 对 于 瞬时 一 致 的 两 个 坐标 系 ， 一 个 为 固定 坐标 
系 ， 另 一 个 为 附着 于 运动 物体 的 运动 坐标 系 ， 以 w 
表示 物体 相对 于 固定 坐标 系 的 角速度 ， 以 vo 表示 物 
体 的 运动 坐标 系 的 原点 0 相对 于 固定 坐标 系 的 速 
度 。 这 样 ， 就 为 物体 的 空间 速度 v 提供 了 Plücker 坐 
标 系 统 。v 的 Pliicker 坐标 就 是 的 w Flv, 的 笛 卡 儿 
坐标 。 


(1.34) 


空间 速度 从 Plücker 坐标 系统 i 到 Plücker 坐标 系 
统 j 的 变换 ， 由 空间 变换 / 耻 , 实现 。 如 果 利 用 v, I v; 
代表 物体 相对 于 坐标 系 ; 和 7 的 空间 速度 , 7p, FIR, 代 


KIERA i 相对 于 坐标 系 7 的 位 置 和 姿态 ， 则 
y, =X v, (1.35) 
其 中 
İR, 0,., 
X,= TE . (1. 36) 
SUp,)R, YR, 
于 是 
| i 'R; 3x3 
as-xX-| o. 7. | (1.37) 
-RSUp) m, 
X, ='X, iX, (1.38) 


Sp.) ERTEKE 
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0 -. t 
p 0 -'p (1.39) 
-p ip 0 


空间 矢量 符号 ， 包 括 此 处 简要 介绍 的 空间 速度 和 
变换 ， 将 在 2.2 节 中 进行 深入 探讨 。 特 别 地 ， 表 2.1 
给 出 了 一 种 采用 空间 变换 的 高 计算 效率 的 算法 。 


13 关节 运动 学 


除非 明确 指出 ， 否 则 ， 机 絮 人 机 构 运 动 学 的 描述 
都 进行 了 一 系列 的 理想 化 假设 。 构 成 机 构 的 连 杆 ， 假 
设 是 严格 的 刚体 ， 其 表面 无 论 位 置 还 是 形状 在 几何 上 
都 是 理想 的 。 相 应 地 ， 这 些 刚体 由 关节 连接 在 一 起 ， 
关节 也 具有 理想 化 的 表面 ， 其 接触 无 间 际 。 这 些 接 触 
面 的 相应 几何 形状 决定 了 两 个 连 杆 间 的 运动 自由 度 ， 
或 者 关节 运动 学 。 

一 个 运动 学 意义 上 的 关节 是 两 个 物体 之 间 的 连 
接 ， 它 限制 了 两 个 物体 间 的 相对 运动 。 相 互 连 接 的 两 


个 物体 构成 一 个 运动 关节 。 两 个 物体 相互 接触 的 表面 
能 够 相互 运动 ， 从 而 允许 两 个 物体 之 间 的 相对 运动 。 
简单 运动 关节 分 为 两 类 ， 分 别 为 面 接触 的 低 副 关 
eT 和 点 或 线 接触 的 高 副 关节 。 
关节 模型 描述 关节 的 一 个 物体 上 的 固定 坐标 系 相 
对 于 另 一 个 物体 上 的 固定 坐标 系 之 间 的 运动 。 该 运动 
用 关节 运动 变量 和 关节 模型 的 其 他 元 素 的 函数 进行 表 
达 ， 关 节 模 型 包括 了 旋转 矩阵 、 位 置 矢量 、 自 由 模 数 
和 受 限 模 数 等 。 一 个 关节 的 自由 模 数 是 其 允许 运动 的 
方向 数 ， 以 6 xn, 的 矩阵 D, 表示 ， 其 列 为 允许 运动 
的 Plücker 坐标 。 该 矩阵 建立 了 通过 关节 的 空间 速度 
ou 与 关节 速度 q 的 联系 
MET (1.40) 
相应 地 ， 一 个 关节 的 受 限 模 数 是 其 不 允许 运动 的 方向 
MX, W6x(6-n,) WO, WAMBO RAN, HS 
RUZ 1.6 给 出 了 本 节 描 述 的 所 有 关节 的 关节 模型 公 
式 ， 它 们 将 进一步 用 于 第 2 章 的 动力 学 分 析 。 关 于 关 
节 的 进一步 信息 参见 第 3 章 。 


R15 单 自由 度 低 副 关节 模型 公式 (缩写 cv = cos0,, s = sin, 
(部 分 来 源 于 参考 文献 [1.21] 的 表 4.1)) 

KW AS HY XAR, MER TE 自由 模 数 o, 受 限 模 数 b; 姿态 状态 变量 à 

0 10000 

0 01000 

co sai 0 0 

旋转 式 1 00000 
Soi cg 0 0 0 0 

R : 0 00100 

js E ow 0 00010 

0 00001 

0 10000 

" 0 01000 

EH 0 00 100 
end 13x3 0 d d 

P j 0 00010 

' 0 00001 

1 00000 

0 1000 0 

ba. mined á 0 0100 Q0 

螺旋 式 1 0000 -h 
Soi cg 0 0 0 0 

H 0 0010 0 

0 0 1 hð; 
0 0001 Q0 
h 0000 1 
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R16 高 自由 度 低 副 关节 模型 公式 (缩写 cw = cos0;, s, =sind, (部 分 来 源 于 


参考 文献 [1.21] 的 表 4.1) ， 欧 拉 角 a, B, ;可 用 


于 替换 单位 四 元 数 e, 表示 姿态 ) 


关节 类 型 关节 旋转 矩阵 /及 Ji EUK Tp, 自由 模 数 o; 受 限 模 数 t 姿态 变量 | 速度 变量 q 
0 0 1000 
| ee Sap 8 0 0 0 0 1 0 0 
柱 面 式 ò 0 1 0 0000 i 0; 
C "ép, UN 1 0 0 00 10 d, E 
P ue d i 0 0 0001 ; 
0 1 0000 
100 000 
ò 0 1 0 0 0 0 
0 0 1 0 0 0 
球面 式 S 见 表 1.1 0 £i Wirel 
i 0 0 0 100 
0 0 0 0 1 0 
0 0 0 00 1 
0 0 0 100 
Co -sa 0 CGA — Sgid i d. MA 6; 6i 
面 式 2 100 0 0 0 d : 
ETE: s c Sg d,; te ; ʻi 
E: i oi 6i xi + Coi yi 010 ü du : dy 
0 0 4 0 0 0 1 0 0 0 » Y 
yi 
0 0 0 00 1 
0 10 0 00 
iom 0 01 0 00 
平面 滚动 co Ssa 0 TO ;Coi — Tso: 
接触 (国定 6 1 0 0 -r 0 0 8 " 
AE Soi i —TU;Sg; —TCoi i i 
Lo Sg Cg TÜ;$g, TC, 0 0 1 0 0 0; 
m P 
i H- We os 9 00 0 10 
00 0 0 1 
— Sgi 0 Cp; 0 0 0 
0 1 0 0 0 0 
Caicgi — — Sai CaiSpi 0 . 
万 向 节 TU Sailpi — Cai — Sai Bi a cg 0 sg 00 0 i Qt 
2: Ü " 0 0 0 0 100 i B, 
0 0 0.0 10 
0 0 0 00 1 
£i w; 
六 自由 度 见 表 1.1 °p; ls 
Pi % 


1.3.1 低 副 关节 


低 副 关节 在 机 械 上 具有 吸引 力 ， 因 为 其 磨损 分 布 


于 整个 表面 ， 而 且 润 滑 六 


空间 (在 非 理 想 化 的 系统 
润 渭 。 由 表面 接触 的 需求 可 以 证 明 ”， 低 副 关节 只 


| 被 密封 于 两 个 表面 的 小 间 院 
PP) ， 能 够 形成 相对 较 好 的 


有 6 种 可 能 的 形式 : 旋转 式 的 、 棱 柱 式 的 、 螺 旋 式 
的 、 柱 面 式 的 、 球 面 式 的 和 平面 式 的 关节 。 


1. 旋转 式 


WERE FE SO R”, ALENT A is Bi eB 
栓 销 。 其 最 常见 的 形式 ， 是 由 两 个 全 等 的 旋转 表面 构 


成 的 低 副 关节 。 两 个 旋转 表 症 


是 相同 的 ， 只 不 过 一 个 
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为 外 表面 ， 法 线 指向 转轴 的 任意 面 ， 且 是 凸 的 ; 另 一 
个 为 内 表面 ， 法 线 指向 转轴 的 任意 面 ， 且 是 四 的。 这 
些 表 面 并 非 仅仅 是 圆柱 表面 ， 因 为 仅 靠 圆柱 表面 不 能 
提供 轴 向 的 滑动 限制 。 旋 转 式 关节 仪 允 许 相 互 连 接 的 
一 个 物体 相对 于 另 一 个 物体 旋转 。 一 个 物体 相对 于 另 
一 个 物体 的 位 置 ， 可 以 利用 指向 关节 轴 的 两 条 法 线 的 
夹 角 表 示 ， 其 中 ， 每 条 法 线 固 定 于 一 个 物体 。 因 此 ， 
该 关节 具有 一 个 自由 度 。 当 旋转 关节 轴 设 定 为 坐标 系 
i 的 2 轴 时 ,旋转 关节 的 模型 见 表 1. 5。 

2. 棱柱 式 

棱柱 式 关节 常 缩写 为 “P”， 有 时 也 众 称 滑动 关 
节 。 其 最 常见 的 形式 ， 是 由 两 个 全 等 的 柱 面 构成 的 低 
副 关节 。 这 些 表 面 并 非 一 定 是 圆柱 表面 ， 通 常 ， 一 个 
柱 面 可 以 由 任意 曲面 沿 一 定 方 向 挤 压 而 成 。 同 样 de 
柱 式 关节 也 有 一 个 内 表面 和 一 个 外 表面 。 楼 柱 式 关节 
仅 允 许 相互 连接 的 一 个 物体 相对 于 另 一 个 物体 沿 挤 压 
方向 滑动 。 沿 平行 于 滑动 的 方向 在 两 个 物体 上 各 选 一 
个 固定 点 ， 则 一 个 物体 相对 于 男 一 个 物体 的 位 置 由 这 
两 点 间 的 距离 确定 。 因 此 ， 该 关节 具有 一 个 自由 度 。 
当 楼 柱 式 关 节 轴 设 定 为 坐标 系 i 的 2 轴 时 ,楼 柱 式 关 
节 的 模型 见 表 1. 5。 

3. 螺旋 式 

螺旋 式 关 节 常 缩写 为 “H”， 有 时 也 俗称 螺杆 关 
节 。 其 最 常见 的 形式 ， 是 由 两 个 全 等 的 螺旋 面 构成 的 
低 副 关节 。 螺 旋 面 可 以 由 任意 曲面 沿 螺旋 路 径 挤 压 而 
成 。 最 简单 的 例子 是 螺杆 和 螺母 ， 其 基本 母 曲 线 是 一 
对 直线 。 螺 旋 角 o 与 一 个 物体 相对 于 另 一 个 物体 沿 轴 
线 的 偏 移 量 d 相关 ， 可 表示 为 d =hd, WBA BAW 
距 。 当 螺旋 关节 轴 设 定 为 坐标 系 i 的 2 轴 时 ， 螺 旋 关 
节 的 模型 见 表 1. 5。 

4. 柱 面 式 
柱 面 式 关节 常 缩写 为 “C”， 是 由 两 个 全 等 的 圆 
面 构成 的 低 副 关节 ， 其 中 一 个 为 内 表面 ， 另 一 个 为 
表面 。 柱 面 式 关 节 人 允许 绕 柱 面 轴 的 旋转 和 沿 平行 于 
主 面 轴 的 平移 。 因 此 ， 它 是 一 个 两 自由 度 关节 。 在 运 
动 学 上 ， 多 于 一 个 自由 度 的 低 副 关节 可 以 利用 复合 关 
节 等 价 替换 (参见 1.3.3 节 )， 即 多 个 单 自由 度 低 副 
关节 构成 的 串联 链 。 在 此 情况 下 ， 柱 面 式 关节 可 以 等 
价 为 一 个 旋转 式 关 节 和 一 个 棱柱 关节 的 串联 ， 且 棱柱 
关节 的 滑动 方向 平行 于 旋转 轴 。 采 用 1.4 节 讨 论 的 几 
何 表 示 实 现 简 单 ， 但 该 方法 不 利于 动态 仿真 。 将 柱 面 
式 关节 作为 棱柱 关节 和 旋转 关节 的 结合 体 进 行 建 模 
时 ， 需 要 在 棱柱 关节 和 旋转 关节 之 间 增 加 虚拟 轴 ， 虚 
拟 轴 的 长 度 和 质量 为 零 。 但 无 质量 连 杆 会 产生 计算 问 
题 。 当 柱 面 式 关节 轴 设 定 为 坐标 系 i 的? 轴 时 ， 柱 面 


Bt 
+ 


Nr 


rai 


式 关节 的 模型 见 表 1. 6。 

5. 球面 式 

球面 式 关节 常 缩 写 为 “S”， 是 由 两 个 全 等 的 球 
面 构成 的 低 副 关节 。 同 样 ， 这 两 个 球面 的 一 个 为 内 表 
面 ， 另 一 个 为 外 表面 。 球 面 式 关 节 人 允许 绕 通过 球 心 的 
任意 直线 旋转 ， 因 此 ， 它 允许 最 多 绕 3 个 不 同方 向 的 
独立 旋转 ， 具 有 3 个 自由 度 。 在 运动 学 上 ， 球面 式 关 
节 可 等 价 为 由 3 个 旋转 式 关 节 构 成 的 复合 关节 ，3 个 
旋转 式 关节 绕 有 公共 点 的 3 个 轴 旋 转 。 尽 管 不 需要 3 
个 轴 连 续 正 交 ， 但 通常 是 采用 3 个 轴 连 续 正 交 的 方 
式 。 通 常 ， 上 述 排列 与 球面 关节 等 价 ， 但 在 旋转 式 关 
节 的 轴线 共 面 时 具有 奇异 性 。 这 与 实际 的 球面 关节 形 
成 对 比 ， 实 际 的 球面 关节 从 不 会 具有 奇异 性 。 类 似 
地 ， 如 果 将 球面 式 关 节 仿 真 建 模 为 3 个 旋转 关节 ， 由 
于 具有 3 个 长 度 和 质量 为 零 的 虚拟 轴 ， 会 导致 出 现 计 
算 困 难 问题 。 球 面 式 关节 的 模型 见 表 1. 6。 

6. 平面 式 

平面 式 由 含有 表面 的 平面 构成 。 类 似 于 球面 式 关 
节 ， 平 面 式 关节 是 具有 3 个 自由 度 的 低 副 关节 。 其 运 
动 学 等 价 复合 关节 ， 由 3 个 绕 平 行 轴 旋 转 的 旋转 式 关 
节 的 串联 链 构 成 。 与 球面 式 关 节 的 情况 类 似 ， 复合 关 
节 在 旋转 式 关节 的 轴线 共 面 时 具有 奇异 性 。 当 平面 式 
关节 的 接触 平面 的 法 线 设 定 为 坐标 系 i 的 2 轴 时 , OP 
面 式 关节 的 模型 见 表 1. 6。 
高 副 关节 

某 些 高 副 关节 同样 具有 吸引 力 ， 特 别 是 一 个 物 
体 在 另 一 个 物体 表面 无 滑动 的 滚动 副 。 这 在 机 械 上 
具有 吸引 力 ， 因 为 没有 滑动 意味 着 没有 磨损 。 但 是 ， 
理想 的 接触 是 一 个 点 或 沿 着 一 条 线 ， 加 载 到 关节 的 
负载 可 能 会 引起 很 大 的 局 部 压力 ， 导 致 其 他 形式 的 
材料 失效 ， 因 而 损坏 。 高 副 关节 可 以 用 于 构造 具有 
特殊 几何 特性 的 运动 关节 ， 如 齿轮 副 或 凸轮 与 从 动 
轮 副 。 

滚动 接触 实际 上 包括 几 种 不 同 的 几何 形状 。 平 面 
运动 的 滚动 接触 允许 一 个 自由 度 的 相对 运动 ， 如 滚 柱 
轴承 。 如 上 所 述 ， 滚 动 接 触 具有 令 人 满意 的 磨损 特 
性 ， 因 为 没有 滑动 意味 着 没有 磨损 。 平 面 滚 动 接触 为 
线 接触 ， 因 此 能 够 稍微 分 散 负载 和 磨损 。 三 维 滚动 接 
触 允 许 绕 通过 接触 点 的 任意 轴 旋 转 ， 接 触 点 在 原理 上 
是 唯一 的 。 因 此 ， 三 维 滚动 接触 副 允 许 3 个 自由 度 的 
相对 运动 。 当 将 过 半径 为 的 滚 轴 中 心 的 滚动 轴线 设 
定 为 坐标 系 i 的 ?2 轴 时 ， 对 于 一 个 在 平面 上 的 深 轴 ， 
其 平面 深 动 接触 关节 的 模型 见 表 1. 6。 

无 论 滚动 接触 关节 是 平面 的 还 是 三 维 的 ， 与 滚动 
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接触 关节 相关 的 无 滑动 条 件 ， 要 求 两 个 物体 上 相互 接 
触 的 点 之 间 的 相对 瞬时 速度 为 0。 如 果 P 是 两 个 物体 
i 和 j 之 间 的 滚动 接触 点 ， 则 

Vp 70 (1.41) 
类 似 地 ， 相 对 加 速度 位 于 接触 点 的 两 个 表面 的 公共 法 
线 方向 上 。 由 于 与 关节 相关 的 约束 以 速度 的 形式 表 
示 ， 因 此 ， 该 约束 为 非 限 定性 约束 ， 参 见 1.3.6 节 。 
关于 滚动 接触 的 运动 学 约束 的 详细 讨论 ， 见 第 17 章 
17.2.2 节 。 


13.3 ”复合 关节 


复合 运动 关节 是 由 多 个 简单 运动 关节 链 构 成 的 两 
个 物体 间 的 连接 。 与 简单 关节 一 样 ， 复 合 关节 也 可 以 
限制 两 个 物体 间 的 相对 运动 。 在 这 种 情况 下 ， 复合 关 
节 与 简单 关节 在 运动 学 上 是 等 价 的 。 

万 向 节 常 缩写 为 “U”， 又 称 为 卡 登 或 虎 克 绞 ， 
是 一 个 具有 两 个 自由 度 的 关节 。 它 由 两 轴 正 交 的 两 个 
旋转 式 关节 串联 链 构 成 。 万 向 节 模 型 见 表 1.6, 其 
中 ， 欧 拉 角 a; ESE Z 轴 的 第 一 次 旋转 ，B, 是 绕 Y 了 轴 


性 驱动 器 如 螺旋 千斤 项、 滚珠 丝 杠 等 很 少 用 做 运动 主 
关节 。 具 有 多 于 一 个 自由 度 的 关节 ， 在 机 器 人 机 构 中 
常用 做 被 动 关节 ， 这 是 因为 主动 关节 的 每 个 自由 度 需 
要 独立 驱动 。 在 机 器 人 机 构 中 ， 被 动 球面 式 关节 很 常 
见 ， 但 被 动 平 面 式 关节 仅 偶 有 所 见 。 驱 动 式 球 关节 ， 
利用 运动 学 上 等 价 为 三 个 旋转 式 关节 分 别 驱 动 实现 。 
万 向 节 在 机 器 人 机 构 中 既 用 于 主动 关节 ， 又 用 于 被 动 
关节 。 
串联 链 常 简 记 为 所 含 关 节 的 顺序 。 例 如 ，RPR 
链 含 有 三 个 连 杆 ， 第 一 个 连 杆 通 过 旋转 式 关节 与 基 座 
连接 ， 第 二 个 连 杆 带 有 棱柱 式 关 节 ， 第 二 个 和 第 三 个 
连 杆 采 用 另 一 个 旋转 式 关节 连接 。 如 果 所 有 关节 是 相 
同 的 ， 则 简 记 为 关节 数量 和 关节 类 型 ， 例 如 ，6R 表 
示 含 有 6 个 旋转 式 关节 的 六 轴 串 联 链 操作 器 。 

以 硬件 实现 关节 ， 要 比 1.3.1 节 和 1.3.2 节 给 出 
的 理想 化 情况 复杂 得 多 。 例 如 ， 一 个 旋转 式 关节 由 滚 
珠 轴承 实现 ， 而 滚珠 轴承 则 有 一 系列 封闭 于 两 个 轴 套 
之 间 的 轴承 滚珠 构成 。 滚 珠 在 轴 套 上 作 无 滑动 的 理想 
滚动 ， 充 分 利用 了 滚动 接触 的 特殊 特性 。 一 个 棱柱 关 


的 旋转 。 对 于 该 关节 而 言 ， 其 矩阵 更 和 Oo RE FH 


数 ， 通常 $B,z0，GB; 0。 在 此 情况 下 ， 外 部 参考 坐 
标 系 的 姿态 随 w 而 变化 。 


六 自由 度 关节 


两 个 不 连接 在 一 起 的 物体 的 运动 ， 可 以 建 模 为 
一 个 无 约束 的 六 自由 度 关节 。 这 对 于 移动 机 器 人 特 
别 有 用 ， 例 如 航空 器 ， 最 多 间 敬 接触 地 面 ， 相 对 于 
国定 坐标 系 自 由 运动 的 物体 称 为 浮动 基 座 。 这 样 一 
个 自由 运动 的 关节 模型 可 使 得 浮动 基 座 在 空间 中 的 
位 置 和 姿态 表示 成 六 关节 变量 。 六 自由 度 关节 模型 
见 表 1.6。 


1.3.4 


1.3.5 物理 实现 


在 实际 的 机 器 人 机 构 中 ,关节 具 有 物理 限制 ， 
超出 该 限制 的 运动 是 被 禁止 的 。 机 器 人 机 构 的 工作 
空间 ( 见 1.5 节 )， 是 在 考虑 到 机 构 中 的 所 有 关节 
的 物理 限制 和 自由 度 的 情况 下 确定 的 。 旋 转 式 关节 
易于 由 旋转 式 电动 机 驱动 ， 因 而 在 机 器 人 系统 中 极 
为 常用 。 关 节 也 可 能 以 被 动 的 、 无 驱动 的 形式 呈现 ， 
这 些 形式 也 非常 常见 ， 但 没有 旋转 式 关 节 这 么 常见 。 
楼 柱 关 节 相 对 来 说 易于 由 线性 驱动 器 驱动 ， 如 液压 
GLE ASG. RRA, Pe TT SE, EN 


节 可 由 滚 轴 导 轨 组 合 构 成 。 
1.3.6 限定 性 和 非 限 定性 约束 


除 滚动 接触 之 外 ， 上 文中 讨论 的 与 关节 相关 的 所 
有 约束 ， 可 以 在 数学 上 表示 为 仪 含有 关节 位 置 变量 的 
方程 ， 称 为 限定 性 约束 。 方 程 的 数量 即 约束 的 数量 为 
6n, 4 为 关节 自由 度 的 数量 。 这 些 约束 是 轴 关 节 模 型 
的 固有 部 分 。 
非 限定 性 约束 是 不 能 单独 利用 位 置 变量 表达 的 
约束 ,但 含有 一 个 或 多 个 位 置 变 量 对 时 间 的 导数 。 
不 能 通过 对 这 些 约 束 方 程 积分 ， 以 单独 获得 关节 变 
量 之 间 的 关系 。 机 器 人 系统 中 ， 最 常见 的 例子 来 自 
于 只 能 滚动 不 能 够 滑动 的 轮子 或 者 滚 轴 。 非 限定 性 
约束 ， 特 别 是 其 在 轮 式 机 器 人 的 应 用 ， 将 在 第 17 章 
详细 讨论 。 


1.3.7 广义 坐标 


在 由 N 个 物体 构成 的 机 器 人 操作 器 中 ， 需 要 ON 
个 坐标 以 便 指 定 所 有 物体 相对 于 一 个 坐标 系 的 位 置 和 
姿态 。 由 于 这 些 物 体 中 有 一 些 是 连接 在 一 起 的 ， 所 以 
有 一 系列 的 约束 方程 建立 了 这 些 坐 标 之 间 的 关系 。 在 
此 情况 下 ，6N 个 坐标 可 以 表达 为 一 个 较 小 的 独立 坐 
标 集 合 q 的 函数 。 该 集合 中 的 坐标 称 为 广义 坐标 ， 而 


Hl 


有 运动 限制 ， 因 为 单 向 滑动 在 理论 上 可 产生 无 穷 大 
扁 移 。 螺 旋 关 节 在 机 器 人 机 构 中 也 较 常 见 ， 尽 管线 


与 其 相关 的 运动 与 所 有 的 约束 是 一 致 的 。 机 器 人 操作 
器 的 关节 变量 g， 是 广义 坐标 的 一 个 集合 "| 。 
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1.4 几何 表示 


将 参考 坐标 系 附着 于 每 一 连 杆 ， 可 以 很 方便 地 定 
义 机 器 人 操作 器 的 几何 关系 。 这 些 坐 标 系 可 以 任意 设 
置 ， 但 坐标 系 设 置 在 连 杆 上 这 一 约定 有 利于 连贯 性 和 
计算 效率 。Denavit 和 Hartenberg! 79 介绍 了 用 于 不 同 
方法 的 基本 约定 ， 其 中 之 一 是 本 手册 采用 的 Khalil 和 
Dombre ”| 提出 的 约定 。 在 所 有 的 形式 中 ， 该 约定 采 
用 四 参数 而 不 是 六 参数 确定 一 个 坐标 系 相 对 于 另 一 个 
坐标 系 的 位 姿 。 这 4 个 参数 分 别 是 : 连 杆 长 度 a, E 
杆 扭 转角 a;， 关 节 偏 移 量 d, KEH 0,。 上 述 简约 参 
数 集 是 通过 下 述 方式 实现 的 : 通过 合理 配置 参考 坐标 
系 的 原点 和 各 个 轴 ， 使 得 一 个 坐标 系 的 * 轴 与 后 续 参 
考 坐 标 系 的 : 轴 相 交 并 垂直 。 该 约定 适用 于 由 旋转 式 
关节 和 棱柱 式 关节 构成 的 操作 器 。 当 存在 多 自由 度 关 
节 时 ， 采 用 旋转 式 关 节 和 棱柱 式 关 节 对 其 建 模 ， 如 
1.3 节 所 述 。 

在 机 器 人 机 构 中 ， 主 要 有 4 种 不 同 的 参考 坐标 系 
配置 约定 ， 直 观 上 每 一 种 均 有 其 优势 。 在 Denavit 和 
Hartenberg!" 5: 的 原创 约定 中 ,关节 i 位 于 连 杆 i 和 
i+] 之 间 ， 在 连 杆 i 的 外 侧 。 同 样 ， 关 节 偏 移 量 d, 和 
关节 角 4 分 别 是 沿 着 或 绕 着 i-1 关节 轴 的 ， 所 以 关 
节 参 数 的 下 标 与 关节 轴 不 对 应 。Waldroni sl 和 
Paul 2 修正 了 原创 约定 中 轴 的 标号 ， 将 关节 i EP 
连 杆 i-1 和 之 间 ， 使 得 串联 链 的 基 座 标号 从 0 FF 
始 。 这 样 ， 关节 i 配置 在 连 杆 i 的 内 侧 ， 这 也 是 所 有 
其 他 修正 版 本 的 约定 采用 的 方式 。Waldron 和 Paul 将 
z, 轴 配置 在 i+1 关节 轴 上 ， 进 一 步 解 决 了 关节 参数 的 
下 标 与 关节 轴 不 对 应 的 问题 。 当 然 ， 这 也 重新 配置 了 
相应 于 关节 轴 和 参考 坐标 系 2 轴 的 下 标 不 对 应 问题 。 
Craig! ”通过 将 $ 轴 配置 在 关节 i 上 ， 删 除了 所 有 的 
不 对 应 下 标 ， 但 代价 是 齐 次 变换 和 矩阵 "7T, 由 下 标 为 i 
的 关节 参数 和 下 标 为 i -1 的 连 杆 参数 构成 。Khalil 和 
DombreW ”给 出 了 男 一 种 版 本 ,分 别 沿 着 和 绕 着 R 
轴 定 义 a; 和 a,， 其 他 类 似 于 Craig 的 版 本 。 在 这 种 情 
况 下 ， 齐 次 变换 矩阵 ”了 T, 完全 由 下 标 为 i 的 参数 构 
成 ， 但 下 标的 不 对 应 体现 为 另 一 种 形式 ，w 和 a 分 
别 代表 连 杆 i-1 的 连 杆 长 度 和 扭转 角 ， 而 不 是 连 杆 i 
的 连 杆 长 度 和 扭转 角 。 总 之 ， 本 手册 中 用 的 约定 与 其 
他 约定 相 比 ， 其 优点 是 参考 坐标 系 的 2 轴 与 关节 轴 具 
有 相同 下 标 ， 定 义 从 参考 坐标 系 i 到 参考 坐标 系 i - 1 
的 空间 变换 的 四 参数 具有 相同 的 下 标 io 


TF 


ARF ATP, (HXBEBRESEIUZUE IE 1.2 所 示 。 


图 1.2 机 器 人 机 构 中 的 物体 与 关节 的 编号 ， 物 体 上 坐标 
系 的 约定 ， 以 及 定位 一 个 坐标 系 相对 于 另 一 个 坐标 系 的 
四 参数 a, . o; 、d; Mo 的 示意 图 


物体 与 关节 的 编号 约定 如 下 : 

1) 机 器 人 机 构 中 的 N 个 运动 物体 从 1 到 NN 编 
号 ， 基 座 编号 为 0。 

2) 机 器 人 机 构 中 的 入 个 关节 从 1 SUN 编号 ， 关 
Di PLFA i -1 和 i 之 间 。 

经 上 述 编号 后 ， 参 考 坐 标 系 约定 如 下 : 

1) 2z, 轴 配置 在 关节 i 的 轴线 上 。 

2) 2 , 轴 位 于 2 , 轴 和 2 轴 的 公 垂 线 上 。 

采用 上 述 坐 标 系 后 ， 定 位 一 个 坐标 系 相 对 于 另 一 
个 坐标 系 的 四 参数 定义 如 下 : 

1) a, 是 沿 着 *,_, 轴 从 &_, 轴 到 3, 轴 的 距离 。 

2) o; 是 绕 着 *_| 轴 从 3,_, 轴 旋转 到 3, 轴 的 转角 。 

3) d, 是 沿 着 2 轴 从 2 , 轴 到 % 轴 的 距离 。 

4) 0, 是 绕 着 ZAMS, DE PE RU Ef 

图 1.3 所 示 的 六 自由 度 串联 链 式 操 作 器 实例 的 几 
何 参数 见 表 1.7。 该 操作 器 的 所 有 关节 为 旋转 式 关 
节 ， 关节 1 垂直 向 上 ， 关节 2 与 关节 1 垂直 并 相交 。 
关节 3 平行 于 关节 2， 连 杆 2 的 长 度 为 a;。 关 节 4 与 
关节 3 垂直 并 相交 。 关 节 5 与 关节 4 垂直 相交 ， 并 与 
关节 3 有 关节 偏 移 量 d,。 最 后 ， 关 节 6 与 关节 5 BE 
相交 。 
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图 1.3 六 自由 度 串联 链 式 操作 器 实例 
(是 一 个 带 有 无 偏 移 量 关 节 和 球面 式 扭转 关节 的 关节 辟 ) 


表 1.7 1. 3 中 串联 链 式 操作 器 实例 的 几何 参数 


1.5 工作 空间 


通常 ， 机 器 人 操作 吉 的 工作 空间 是 指 操作 器 执行 
所 有 可 能 的 运动 时 末端 扫 过 的 全 部 体积 ， 是 由 操作 器 
的 几何 形状 和 关节 运动 的 限 位 决定 的 。 特 别 地 ， 可 达 
空间 定义 为 末端 能 够 到 达 的 所 有 点 的 集合 ， 而 灵巧 空 
间 中 为 末端 能 够 以 任意 姿态 到 达 的 所 有 点 的 集合 ， 
灵巧 空间 是 可 达 空 间 的 子 集 。 灵 巧 空间 仅 存 在 于 特定 
的 理想 几何 构 型 ， 真 正 的 工业 操作 器 带 有 关节 限 位 ， 
几乎 从 来 没有 灵巧 空间 。 
许多 串联 链 式 机 器 人 操作 器 是 如 此 设计 的 ， 其 关 
节 分 成 区 域 性 结构 和 方向 性 结构 。 区 域 性 结构 关节 实 
现 末 端 在 空间 中 的 位 置 定 位 ， 而 方向 性 结构 关节 实现 
末端 的 姿态 。 较 典型 地 ， 串 联 链 式 机 器 人 操作 器 的 内 
关节 由 区 域 性 结构 构成 ， 而 外 关节 由 方向 性 结构 构 
成 。 此 外 ， 楼 柱 式 关节 不 能 提供 旋转 能 力 ， 所 以 不 能 
用 于 方向 性 结构 。 

区 域 性 工作 空间 ， 可 由 串联 链 式 机 器 人 操作 融 的 
已 知 几 何 构 型 和 关节 运动 限 位 计算 获得 。 在 由 区 域 性 
结构 构成 的 三 个 内 关节 中 ， 首 先 计算 外 侧 的 两 个 关节 


i Q; a; d; 0; 
1 0 0 0 6, 
2 E 0 0 6; 
3 0 a; 0 0; 
4 一 x 0 d, 9, 
5 > 0 0 6, 
6 eS 0 0 06 


在 该 约定 下 ， 通 过 绕 *,_, 轴 旋转 角度 a, IW x, 
轴 平 移 a,， 绕 2., 轴 旋转 角度 0,， 沿 2, 轴 平移 d;， 可 实 
现 参考 坐标 系 i 相 对 于 参考 坐标 系 i -1 的 定位 。 通 过 
这 些 独立 变换 的 串联 ， 
Rot(x, , , o) Trans(X, ,, a;) Rot(2,, 0,) Trans(2,, d;) , 
得 到 的 等 价 齐 次 变换 为 


CosO， — sind, 0 a; 
—— sin0;cosa;  cosÓ;cosa;  —sina; —sina,d; 
i sinOÜ;sina; cos0;sina; cosa; cosa,d; 
0 0 0 1 
(1.42) 


上 述 几何 参数 的 辨识 在 第 14 章 给 出 。 


(关节 2 和 3) 的 工作 空间 面积 ， 然 后 通过 对 剩余 的 
内 关节 (关节 1) 的 关节 变量 的 积分 ， 计 算出 区 域 性 
工作 空间 的 大 小 。 对 于 棱柱 式 关 节 ， 仅 需 将 面积 乘 以 
棱柱 式 关节 的 运动 长 度 。 对 于 更 为 普遍 的 旋转 式 关 
节 , 它 涉及 绕 关节 轴线 的 全 范围 旋转 运动 的 面 
fA?) | 根据 Pappus 定理 ， 相 关 的 空间 体积 》 
V-Ary (1.43) 
AP, 4 是 面积 ，7 是 面积 的 质心 到 旋转 轴线 的 距离 ， 
y 是 该 面积 旋转 的 角度 。 该 面积 的 边界 通过 跟踪 末端 
一 个 参考 点 的 运动 确定 ， 较 典型 的 是 方向 性 结构 腕 部 
的 旋转 中 心 。 从 两 个 关节 的 运动 限 位 位 置 开 始 ， 关 节 
2 锁定 ， 关 节 3 一 直 运 动 到 其 第 二 个 限 位 位 置 。 然 
后 ,关节 3 锁定 ， 关节 2 自由 运动 到 其 第 二 个 限 位 位 
置 。 关 节 2 再 次 锁定 ,关节 3 自由 运动 到 其 初始 限 位 
人 位置。 最后， 关节 Be, X12 自由 运动 到 其 初始 
限 位 位 置 。 在 这 种 方式 下 ， 参 考点 的 轨迹 是 一 条 封闭 
上 线 ， 其 面积 和 质心 可 以 通过 数学 方法 计算 出 来 。 
操作 器 空间 的 更 多 细节 参见 第 3 章 和 第 10 章 。 


1.6 正 向 运动 学 


串联 链 式 操作 器 的 正 向 运动 学 问题 ， 是 在 给 定 所 
有 关节 位 置 和 所 有 连 杆 几何 参数 的 情况 下 ， 求 取 未 端 
相对 于 基 座 的 位 置 和 姿态 。 通 常 ， 固 定 于 末端 的 坐标 
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系 称 为 工具 坐标 系 ， 它 同时 国定 于 来 端 连 杆 V b, 以 图 1.3 所 示 的 串联 链 式 操作 器 为 例 ， 忽 略 附加 
在 位 置 与 姿态 上 通常 与 坐标 系 入 具有 固定 偏 移 。 类 ”的 工具 和 工作 站 坐标 系 ， 其 变换 为 
似 地 ， 一 个 国定 坐标 系 常设 置 于 基 座 上 ， 以 确定 被 执 MUN 
行 任务 的 位 置 。 该 坐标 系 在 位 姿 上 通常 相对 于 坐标 系 Tee Eads Es (hey) 
0 具有 国定 偏 移 ， 坐 标 系 0 也 固定 于 基 座 上 。 


几何 结构 ， 以 及 与 机 构 自 


US 


正 向 运动 学 问题 的 更 一 般 性 描述 是 ， 给 定 操作 器 的 


由 度数 量 相 等 的 关节 数量 的 关 


HME, 求 取 任意 两 个 指定 关节 之 间 的 相对 位 置 和 姿 
态 。 正 向 运动 学 对 于 开发 操作 咒 坐 标 算法 十 分 重要 ， 这 


是 因为 关节 位 置 常 由 安装 于 关节 和 
且 有 必要 计算 关节 轴 相 对 于 固 


传 感 吉 测量 得 到 ， 而 
定 参考 坐标 系 的 位 置 。 


实践 中 ， 正 向 运动 学 问题 通过 计算 两 个 坐标 系 之 
间 的 变换 来 求解 ， 一 个 是 固定 于 末端 的 参考 坐标 系 ， 
男 一 个 是 固定 于 基 座 的 参考 坐标 系 ， 即 工具 坐标 系 和 


工作 站 坐标 系 。 对 于 串联 链 而 言 ， 
因为 描述 末端 相对 于 基 座 位 置 的 变换 是 从 链 路 中 国定 
T4H4 
出 的 操作 器 几何 表示 的 约定 ， 将 上 述 变 换 简 化 为 求 取 
4x4 f 
对 于 基 座 坐标 系 的 空间 


该 变换 是 前 


向 的 ， 


bp 连 杆 坐标 系 之 间 的 变换 串联 得 到 的 。1.4 节 给 


的 等 价 齐 次 变换 矩阵， 该 矩阵 为 末端 坐标 系 相 
WE 


R18 PRAT. 的 各 个 元 素 ， 它 们 是 由 表 1.7 和 式 
(1.42) 计算 出 来 的 。 

再 次 说 明 ， 章 次 变换 提供 了 一 种 简洁 的 符号 ， 但 
在 求解 正 向 运动 学 问题 时 其 计算 效率 较 低 。 通 过 分 离 
变换 中 的 位 置 和 姿态 部 分 ， 删 除 矩 阵 中 所 有 的 与 0 和 
1 的 乘法 ， 可 以 降低 计算 在 第 2 章 ， 利 用 空间 矢 


三 
Eo 


LEVA] 


量 符号 进行 计算 ， 这 些 符 号 在 1. 2. 6 节 中 进行 了 简要 
介绍 ， 详 细 解释 见 2.2 节 。 该 方法 不 需要 齐 次 变换 ， 


但 将 旋转 矩阵 和 位 置 分 离 以 提高 计算 效率 。 表 2. 1 给 
出 了 详细 的 公式 ， 特 别 是 与 正 向 运动 学 问题 相关 的 空 
间 变 换 的 积 。 

运动 树 是 不 含 闭环 的 机 器 人 机 构 的 普遍 结构 ， 树 
结构 的 正 向 运动 学 在 第 2 章 给 出 。 由 于 附加 的 约束 ， 
闭 链 的 正 向 运动 学 问题 要 复杂 得 多 。 闭 链 的 求解 方法 
见 第 12 章 。 


表 1.8 图 1.3 串联 链 式 操作 器 的 正 向 运动 学 


Tn D Tis P6 

0 y 

oT = Ta mo Tog PG 
n 0 z 
T31 T32 T33 Pe 

0 0 0 1 


Ti = Ca (55g 一 CC 有 ) (so4s06 — Ca Cos Cos) — Co Sos Cos Cos 5g Cm ) * 5g (Ss Cos Cos Caso) » 


ra 235g (555 — € € ) (Sm Sas — Cat Cos Cos ) — SeiSos Cao (Cp Ses + Sm 


cmp) —co (Sg Cos Cos 十 Cosb ) ， 


T31 = (Ciis Sip Cus ) (sas — Cat Cos Cos) + Ses Cos (SSB — Cm C ) ， 


Ti 2 Cà (SSB — Co Cg ) (Coi Cos So Spi Cos) + Car Sos Sas (Ces + so 


Ces) * Sa (Carlos — Spi Cos Soo ) ， 


T3) 25g (ss — € € ) (Cocosse6 + 80405) +561 505806 (Cp + Sen 


Cos) — Ca (CCo 7 50 Cosas ) ， 


T32 = (cos 5p €gy ) (Cocosos 5Q1 Cos) — sesso (S258 — CMe) » 


Ti5 2 Cg Cusa (SSB — Cp C) -coco (CS t Cm) — sg sos0, 


Tj = Sei Case (SSB — Cele) Sp Cos (CS Smp Cm ) + Canis » 


T33 2 Cse (€ 595 +See) + C (spse — Com), 


0 xz 
Po = 43C a Cm — daco (655 t 5C), 


O29 - 
PS 74559 € — dasa (Corse * 5C ) ， 


0 = _ 
Po = -asm * di (5g 一 coco )- 


TE: 缩写 cw =c0s0,, sj; =sind; 


1.7 逆向 运动 学 


串联 链 式 操作 器 的 逆向 运动 学 问题 ， 是 在 给 定 末 
端 相 对 于 基 座 的 位 置 和 姿态 ， 以 及 所 有 连 杆 几何 参数 
的 情况 下 ， 求 取 所 有 关节 的 位 置 。 再 次 声明 ， 这 只 是 
对 串联 链 的 简单 描述 。 更 普遍 的 描述 为 : 给 定 一 个 机 
构 两 部 分 的 相对 位 置 和 姿态 ， 求 解 所 有 关节 位 置 的 
值 。 这 相当 于 给 定 感 兴趣 的 两 部 分 之 间 的 齐 次 变换 ， 
求 取 所 有 关节 的 位 置 。 

在 一 般 情况 下 ， 对 于 六 自由 度 串 联 链 式 操作 器 ， 
已 知 变换 为 "Ts 。 重 新 审视 1.6 节 中 该 变换 的 公式 ， 
可 以 发 现 串联 链 式 操 作 器 的 逆向 运动 学 问题 需要 求解 
非 线 性 方程 组 。 对 于 六 自由 度 操 作 融 ， 有 3 个 方程 与 
其 齐 次 矩阵 中 的 位 置 撩 量 有 关 ， 男 外 3 个 与 旋转 矩阵 
有 关 。 后 者 中 ， 由 于 旋转 矩阵 的 独立 性 问题 ， 这 3 个 
方程 不 能 来 自 相 同 的 行 或 列 。 这 些 非 线性 方程 ， 可 能 
无 解 或 者 存在 多 解 ”” 。 对 于 一 个 存在 的 解 ， 末 端的 
期 望 位 置 和 姿态 一 定位 于 操作 器 的 工作 空间 。 对 于 确 
实 存在 解 的 情况 ， 这 些 解 常 常 不 能 表示 为 闭 式 解 ， 所 
以 需要 采用 数值 方法 。 


闭 式 解 


由 于 闭 式 解 比 数值 解 速度 快 ， 而 且 容 易 区 分 所 有 
可 能 的 解 ， 所 以 希望 得 到 闭 式 解 。 闭 式 解 的 缺点 是 不 
通用 ,依赖 于 机 器 人 。 求 取 闭 式 解 的 最 有 效 方法 ， 是 
充分 利用 特定 机 构 几 何 特征 的 专门 技术 。 通 常 ， 对 于 
六 自由 度 机 器 人 ， 仪 带 有 特定 运动 结构 的 、 大 量 几何 
参数 (在 1.4 节 定 义 ) 为 0 的 机 器 人 ， 能 够 获得 闭 式 
解 。 大 部 分 工业 操作 器具 有 这 种 结构 ， 因 为 该 结构 允 
许 更 加 有 效 的 坐标 软件 。 六 自由 度 操 作 器 具有 逆 运 动 
学 闭 式 解 的 充分 条 件 为 

1) 三 个 连续 的 旋转 式 关节 的 轴线 相交 于 一 点 ， 
如 球面 式 腕 部 。 

2) 三 个 连续 的 旋转 式 关节 的 轴线 平行 。 

闭 式 解 方法 可 分 为 代数 法 和 几何 法 。 

1. 代数 法 

代数 法 涉及 辨别 含有 关节 变量 的 有 效 方程 ， 并 将 
其 处 理 成 可 解 的 形式 。 一 种 常用 的 策略 是 简化 为 单 变 
量 的 超越 方程 ， 如 
C,cos0; + C,sin0; + C, =0 (1.45) 


RP, C. C, 和 C, 是 常数 。 式 (1.45). 的 解 为 


1.7.1 


2 _ pea 
0; ECC Ea -C+ (1. 46) 
C, - C, 
有 一 个 或 多 个 常数 为 0 的 特殊 情况 ， 也 较 常 见 。 
简化 为 具有 如 下 形式 的 一 对 方程 : 
e t Csin; + C, =0 


(1.47) 
Cising, — C,cos0; + C, =0 


是 另 一 种 特别 有 用 的 策略 ， 因 为 它 只 有 一 个 解 
6, = Atan2( -C,C,-C,C,, CC, - C,C,) (1.48) 


2. 几何 法 

几何 法 涉及 辨别 末端 上 的 点 ， 其 位 置 和 (x) 
姿态 可 以 表达 为 关节 变量 的 简约 集 的 函数 。 这 相对 于 
将 空间 问题 分 解 为 分 离 的 平面 问题 ， 形 成 的 方程 采用 
代数 方法 求解 。 上 述 的 六 自由 度 操作 器 闭 式 解 存在 的 
两 个 充分 条 件 ， 使 得 逆向 运动 学 问题 可 分 解 为 逆向 位 
置 运动 学 和 逆向 姿态 运动 学 。 这 也 是 1. 5 节 讨 论 的 区 
域 性 结构 和 方向 性 结构 上 的 分 解 , 重 写 式 (1.44) 
可 获得 其 解 : 


"TéTiT;T,-"T/T]T, (1.49) 
图 1.3 中 的 操作 器 具有 这 种 结构 ， 其 区 域 性 
SERA AS BK AD BEE TK BM TE, BC IPT RHR PE a. 
这 种 结构 的 逆向 位 置 运动 学 的 解 见 表 1.9。 由 于 4， 
具有 两 个 解 ， 相 应 地 0, 和 0, 对 应 于 每 一 个 90, 具 
有 两 个 解 ， 所 以 贸 链 臂 式 操作 絮 的 逆向 位 置 运动 
学 共有 4 个 解 。 其 姿态 结构 是 简单 的 球 式 手腕 ， 
相应 的 解 见 表 1.10, z& 1.10 中 给 出 了 9; 的 两 个 
ft, 但 0 和 6 对 应 于 每 一 个 9; 只 有 一 个 解 。 因 
此 ， 球 式 手腕 的 逆向 姿态 运动 学 具有 两 个 解 。 结 
合 区 域 性 结构 和 姿态 结构 ， 图 1.3 中 操作 器 的 首 
向 运动 学 解 共 有 8 个 。 
表 1.9 图 1.3 PRBS THREE 
逆向 位 置 运动 学 


0, = Atan2(^pz, pi) 或 者 Atan2( - "pj, -Ppi) 


6, = —Atan2(D, + /1-D*), Ep, 


_ (pt)? + (pe)? + Ong)? - a8 - dà 


D 2a; d4 


6, =Atan2 (°p, (°p)? + p^) - 


Atan2 (d,sin0, , a, + d4cos0,) 
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R110 图 1.3 串联 链 式 操作 器 中 的 球 式 手 腕 的 
逆向 姿态 运动 学 


2 
05 2 Atan2( € /1 — (14389 -ra3co) ,riaso 7 2360 ) 


0, = Atan2 ( F (risegi T2558 )5(9 403) +133C(02 +63) > 


* (ri€g T3358 ) (p 403) F T335(g +03) ) 


Og = Atan2( + (risa t 756g), + (TS 7 269)) 


TE: 缩写 cw =cos0,, sj; =sind; 


1.7.2 数值 法 


不 同 于 求 取 闭 式 解 的 代数 法 和 几何 法 ， 数 值 法 不 
依赖 于 机 器 人 ， 故 可 用 于 任意 运动 学 结构 。 数 值 法 的 
缺点 是 速度 较 慢 ， 在 某 些 情况 下 不 能 计算 出 所 有 可 能 
的 解 。 对 于 一 个 仅 有 旋转 式 关 节 和 楼 柱 式 关节 的 六 自 
由 度 串 联 链 式 操作 器 ， 其 平移 和 旋转 方程 总 能 化 简 为 
单 变量 的 多 项 式 ， 其 阶 次 不 超过 16 re), Alt, 
这 样 的 一 个 操作 器 的 逆向 运动 学 问题 有 16 个 实数 
解 ” 。 因 为 只 有 当 一 个 多 项 式 的 阶 次 不 超过 4 阶 时 
其 闭 式 解 是 可 能 得 到 的 ， 所 以 许多 操作 器 构 型 是 不 能 
获得 闭 式 解 的 。 通 常 ， 较 多 数量 的 非 零 几 何 参数 ， 对 
应 于 化 简 后 较 高 阶 次 的 多 项 式 。 对 于 这 样 的 操作 器 ， 
最 常用 的 数值 解 方法 分 为 符号 消 元 法 、 延 拓 法 和 选 
代 法 。 

1. 符号 消 元 法 

符号 消 元 法 涉及 从 非 线性 方程 系统 删除 变量 的 
解析 操作 ， 以 便 将 其 化 简 为 含有 较 少 方程 的 方程 组 。 


因此 , 初始 猜测 的 质量 对 求解 时 间 有 具有 很 大 影响 。 
Newton- Raphson 法 提供 了 一 种 对 原始 方程 进行 一 阶 近 
似 的 基本 方法 。Pieper 上 六 是 最 早 将 这 种 方法 用 于 道 
向 运动 学 的 人 之 一 ， 其 他 人 随后 上 “1 。 优 化 方法 将 
逆向 运动 学 问题 形式 化 为 非 线性 优化 问题 ， 并 采用 搜 
索 技术 从 初始 猜测 移动 到 解 。 求 解 运动 率 控制 将 上 述 
问题 转化 为 一 个 微分 方程 "”i， 而 且 一 种 修正 的 预 
测 一 一 矫正 算法 可 用 于 对 关节 速度 积分 一 ?1 。 基 于 控 
制 理论 的 方法 将 微分 方程 归于 控制 问题 小。 间隔 分 
pr^! 或许 是 最 有 前 途 的 迭代 方法 之 一 ， 因 为 它 可 以 
快速 收敛 到 一 个 解 ， 并 能 找到 所 有 的 可 能 解 。 对 于 复 
杂 机 构 ， 阻 尼 最 小 二 乘法 “1 特别 具有 吸引 力 ， 更 多 
细节 见 第 11 章 。 


1.8 正 向 微分 运动 学 


串联 链 式 操作 器 的 正 向 微分 运动 学 问题 是 ， 给 
定 链 路 中 所 有 单元 的 位 置 和 所 有 关节 的 运动 速率 ， 
求解 末端 的 合 速 度 。 此 处 的 关节 运动 速率 ， 是 绕 旋 
转 式 关节 旋转 的 角速度 ， 或 者 沿 棱柱 关节 滑动 的 平 
移 速 度 。 单 元 的 合 速度 是 固定 于 单元 的 参考 坐标 系 
原点 的 速度 与 单元 角速度 合成 的 。 换 言 之 ， 合 速度 
有 6 个 独立 分 量 ， 可 以 完全 代表 单元 的 速度 场 。 值 
得 注意 的 是 ， 该 定义 包含 了 如 下 假设 : 机 构 的 姿态 
是 完全 已 知 的 。 在 大 部 分 情况 下 ， 这 意味 着 在 处 理 
正 向 微分 运动 学 之 前 ， 必 须 处 理 正 向 运动 学 问题 或 
者 逆向 运动 学 问题 。 在 下 节 中 讨论 的 逆向 微分 运动 
学 也 存在 同样 情况 。 当 为 了 研究 动力 学 而 进行 加 速 


Raghavan 和 Roth? R JH Brit i 262A, KGa AA A 
由 度 旋 转 式 串 联 链 式 操作 器 的 逆向 运动 学 问题 化 简 
为 一 个 16 阶 多 项 式 ， 并 求 取 所 有 可 能 的 解 。 多 项 式 
的 根 提供 的 是 其 中 一 个 关节 变量 的 解 ， 而 其 他 的 变 
量 通 过 求解 线性 系统 获得 。Manocha 和 Canny!" 通 
过 将 该 问题 重新 形式 化 为 一 般 的 特征 值 问题 ， 改 进 
了 该 项 技术 的 数值 特性 。 另 一 种 消 元 方法 是 采用 
Grobner FELL 44] | 

2. 延 拓 法 

延 拓 法 涉及 解 的 路 径 跟 踪 。 延 拓 法 从 具有 已 知 解 
的 起 始 系 统 开 始 ， 随 起 始 系 统 到 目标 系统 的 变换 ， 跟 
踪 到 求解 的 目标 系统 。 这 些 技术 已 用 于 逆向 运动 学 问 
NS) ， 其 多 项 式 系统 的 特殊 特性 可 用 于 求 取 所 有 可 
AEA fp nt 。 

3. 和 迭代 法 

许多 不 同 的 迭代 法 可 用 于 解决 逆向 运动 学 问题 。 
基于 初始 猜测 ， 大 部 分 迭代 法 能 够 收敛 于 一 个 单 解 。 


度 分 析 时 ， 正 向 微分 运动 学 问题 是 重要 的 。 计 算 科 
ERA] (Coriolis) 加 速度 和 向 心 加 速度 分 量 ， 需 要 
单元 的 合 速度 。 

正 向 运动 学 对 时 间 的 导数 ， 即 为 如 下 形式 的 方 
程 组 


vy =J(q)g (1.50) 
SU, vy 是 末端 的 空间 速度 ，9 是 由 关节 速率 构成 
NÆRE, J(q) 是 6 xN 的 和 矩阵， 其 值 通常 是 
Gis 5 dy 的 非 线 性 函数 。J(g) 称 为 该 代数 系统 的 
雅 可 比 矩 阵 ， 对 应 于 与 空间 速度 ww 相同 的 坐标 
AOS) 。 如 果 关 节 位 置 已 知 ， 则 式 (1.50) 将 形成 6 
个 关节 速率 的 线性 代数 方程 。 如 果 给 定 关节 速率 ， 则 
式 (1.50) 的 一 个 解 就 是 正 向 微分 运动 学 问题 的 一 
个 解 。 注 意 ， 所 有 关节 位 置 已 知 的 情况 下 ,J(g) 可 
以 认为 是 一 个 已 知 矩 阵 。 
利用 在 1. 2.6 节 简 要 介绍 并 将 在 2. 2 节 详 细 解 释 
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的 空间 矢量 符号 ， 雅 可 比 矩 阵 可 很 容易 地 从 关节 的 自 
由 模 数 o, 和 相关 的 空间 变换 "已 计算 出 来 。 与 关节 
速率 4 相关 的 J(q) 的 列 为 

‘XG, 
AP, AAR w 所 在 的 任意 坐标 系 。 在 本 手册 中 ， 
表 1. 11 包含 了 有 效 计算 雅 可 比 和 矩阵 各 列 的 算法 。 关 
于 雅 可 比 矩 阵 的 进一步 信息 参见 第 11 章 。 


表 1.11 从 关节 的 自由 模式 计算 雅 可 比 


矩阵 列 的 算法 

n; 关节 i 的 自由 度 的 数量 

J ‘yy 2J(q) 9 ,大 是 任意 坐标 系 

Jii J 的 与 4 ;相关 的 n; 列 

o, D 的 前 三 行 

b, ® 的 后 三 行 

J,; 2 X;; 

表达 式 计算 值 
X,X, (RR,; p; * Rip,) 

xo (R®,; R(Ó, -pxo,)) 
x7! (R', -Rp) 
Xo (R'®,; R'®, +p xR'®,) 


1.9 逆向 微分 运动 学 


从 机 器 人 坐标 的 观点 看 ， 逆 向 微分 运动 学 问题 是 
一 个 非常 重要 的 问题 。 关 于 机 器 人 坐标 的 更 多 信息 
见 第 5 章 和 第 6 章 。 串 联 链 式 操 作 器 的 道 向 微分 运 
动 学 问题 是 : 给 定 链 路 中 所 有 单元 的 位 置 和 末端 的 
合 速度 ,求解 所 有 关节 的 运动 速率 。 当 控制 一 台 以 
点 对 点 模式 操作 的 工业 机 器 人 的 运动 时 ， 不 仅 需要 
计算 与 期 望 的 手 爪 终点 位 置 对 应 的 终点 关节 位 置 ， 
而 且 需 要 在 起 点 和 终点 位 置 之 间 形成 光滑 的 运动 轨 
W., "495, 会 有 无 限 多 的 可 能 轨迹 符合 此 要 求 。 但 
是 ， 最 直接 最 成 功 的 方法 采用 基于 逆向 微分 运动 学 
问题 的 解 的 算法 。 该 项 技术 起 源 于 Whitney 7 和 
Pieper!" 的 工作 。 

vy 已 知 时 ， 通 过 将 式 (1.50) 分 解 为 分 量 方 
程 ， 可 以 获得 由 含有 关节 速率 的 多 个 方程 构成 的 线性 
系统 。 为 了 求解 该 线性 系统 ， 有 必要 求 取 雅 可 比 和 矩阵 


des 


Box. 于是, st (1.50) 变 为 

å =J (v, (1.51) 
由 于 了 是 一 个 6 x 6 WHERE, PiL TE A UA 
100Hz 及 以 上 的 速度 运行 的 实时 软件 中 ， 其 数值 道 不 
ERA RSH, WME, J 很 可 能 变 成 奇异 的 
( | 了 |=0)， 其 逆 不 存在 。 关 于 奇异 性 的 进一步 信息 
参见 第 3 章 和 第 12 章 。 即 使 雅 可 比 和 矩阵 不 是 奇异 的 ， 
它 也 可 能 是 病态 的 ， 导 致 在 操作 器 的 大 部 分 工作 空间 
中 性 能 退化 。 大 部 分 工业 机 器 人 的 构 型 比较 简单 ， 其 
雅 可 比 矩 阵 可 以 解析 求 遂 ， 形 成 关节 速率 的 显 式 方程 
组 1%%] 。 与 数值 求 逆 相 比 ， 这 样 可 极 大 地 降低 计算 
量 。 对 于 更 加 复杂 的 操作 器 构 型 ， 数 值 求 着 是 唯一 的 
方法 。 宛 余 操作 器 的 雅 可 比 矩 阵 不 是 方 阵 ， 所 以 不 能 
Xo, 88 11 章 讨 论 了 在 这 种 情况 下 如 何 应 用 各 种 
thst, 


1.10 静 力 变换 


操作 器 的 静 力 变换 ， 建 立 了 施加 于 末端 的 扭矩 与 
施加 于 关节 的 力 /力矩 之 间 的 关系 。 这 对 于 控制 操作 
器 与 其 环境 的 交互 作用 是 十 分 重要 的 。 交 互 作用 的 例 
子 包 括 涉及 国定 或 伪 国定 工件 的 任务 ， 例 如 ， 以 特定 
力 插件 ， 以 特定 力矩 拧紧 螺母 等 。 更 多 信息 见 第 7 章 
和 第 27 章 。 利 用 虚 功 原理 ， 施 加 于 未 端的 扭矩 与 施 
加 于 关节 的 力 /力矩 之 间 的 关系 可 表示 为 

T-J f, 
式 中 ,Tf 是 施加 于 EE EPR ERR CAT n 维 力 / 力 
ERE, f, 是 空间 力 矢量 


«(D 


AF, n Af 分别 是 施加 于 末端 的 力矩 和 力 矢 量 ， 均 
与 雅 可 比 矩 阵 位 于 同一 个 参考 坐标 系 。 因 此 ， 以 与 关 
节 速 率 映 射 到 末端 空间 速度 同样 的 方式 ， 雅 可 比 和 矩阵 
将 施加 于 末端 的 扭矩 映射 到 施加 于 关节 的 力 /力矩 。 
在 速度 方式 下 ， 当 雅 可 比 和 矩阵 不 是 方 阵 时 ， 其 逆 关 系 
不 是 唯一 的 。 


(1.52) 


(1.53) 


111 结论 与 扩展 阅读 


本 章 简要 回顾 了 如 何 将 运动 学 的 基本 原理 应 用 了 
机 器 人 机 构 ， 内 容 涉及 空间 中 刚体 的 位 置 和 姿态 的 各 
种 表示 、 关 节 的 运动 自由 度 与 相应 数学 模型 、 描 述 机 
项 人 机 构 的 几何 表示 、 操 作 咒 的 工作 空间 、 正 向 和 逆 


26 


第 1 篇 


机 器 人 学 基础 


向 运动 学 问题 、 正 向 和 逆向 微分 运动 学 问题 (包括 雅 


可 比 矩 阵 的 定义 ) 、 


静 力 变换 。 当 然 ， 本 章 不 能 包罗 


运动 学 的 全 部 。 幸 运 的 是 ， 大 量 优秀 文献 对 重点 研究 
运动 学 的 机 器 人 学 提供 了 广泛 的 介绍 17,27 ,29,30,51,59-63] : 
从 历史 上 看 ， 机 器 人 学 从 本 质 上 改变 了 机 构 运 动 学 领 
域 的 性 质 。 在 首次 出 现 关 于 机 器 人 的 坐标 方程 之 


HU 


前 ， 机 构 领 域 的 焦点 几乎 全 部 集中 于 单 自由 度 
机 构 。 


这 就 是 为 什么 随 着 数字 计算 的 来 临 ， 机 器 人 学 


给 机 构 运 动 学 带 来 了 新 生 。 更 多 的 细节 见 第 3 章 。 正 
如 该 领域 从 工业 机 器 人 的 简单 串联 链 的 研究 (本章 分 
析 的 重点 ) 中 扩展 开 来 一 样 ， 该 领域 还 在 继续 朝 着 不 


同方 向 发 展 ， 如 并 联机 器 ( 见 第 12 章 )、 


Ji MBL F 


(第 15 Æ), 、 机 器 人 运输 车 〈 第 16 章 和 第 17 35), 其 
至 小 型 机 器 人 ( 见 第 18 章 ) 。 
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HA 力 学 


Roy Featherstone, David E. Orin 


刚体 的 动力 学 方程 提供 了 机 器 人 机 构 驱 动 和 作 


uu 


于 其 上 的 接触 力 之 间 的 关系 ， 以 及 带 来 的 加 速度 


和 运动 轨迹 的 关系 。 动 力学 在 机 械 设计 、 控 制 和 仿 
真 计算 中 都 十 分 重要 。 在 这 些 应 用 中 ， 也 有 许多 重 


要 算法 ， 其 中 包括 下 列 计算 : 道 向 动力 学 、 正 向 动 
力学 、 关 节 空 间 惯 性 矩阵 和 操作 空间 惯性 和 矩阵。 本 
章 提 供 的 有 效 算 法 ， 用 于 机 器 人 机 构 刚 体 模 型 上 ， 


实现 对 上 述 问题 的 计算 。 这 些 算 法 采用 最 通 


j 的 形 


式 ， 适 用 于 具有 一 般 连 接 性 、 几 何 形 状 和 关节 类 型 
的 机 器 人 机 构 。 这 些 机 构 包 括 : [Al aE SEE DL tt A 


移动 机 器 人 ， 以 及 并 联机 器 人 机 构 。 


除了 计算 效率 的 需要 外 ， 算 法 还 应 该 公式 化 为 
一 组 紧凑 方程 ， 以 便于 开发 和 实现 。 空 间 记 法 在 这 
方面 非常 有 效 ， 可 用 于 描述 动力 学 算法 。 空 间 矢量 
代数 是 一 种 简洁 的 矢量 记 法 ， 它 采用 6 维 矢量 和 张 


量 ， 来 描述 刚体 的 速度 、 加 速度 、 惯 性 等 。 


本 章 的 目的 在 于 向 读者 介绍 机 融 人 动力 学 ， 并 


以 紧凑 形式 提供 一 组 丰富 的 算法 ， 读 者 可 将 其 应 


uu 


到 他 们 的 特定 机 如 人 机 构 中 。 为 方便 随时 查阅 ， 这 


些 算法 将 采用 表格 形式 。 


1.1 空间 矢量 记 法 n 
129 EW Bb e hee sep 
1.3 ”刚体 系统 动力 学 模型 ……………………… 
1.4 运动 树 Sr Ie EA erae 1 aa OUS 


zx 间 矢 量 记 法 oe CERE AE E i 


2.6 坐标 变换 owes Meere ctun diei ese ANEREN aed 
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第 2 章 动力 学 29 


2.1 概述 


机 器 人 动力 学 提供 了 驱动 和 接触 力 之 间 的 关 
系 ， 以 及 带 来 的 加 速度 和 运动 轨迹 的 关系 。 运 动 
体 的 动力 学 方程 是 许多 算法 的 基础 ， 这 些 算 法 可 
用 于 机 械 设计 、 控 制 及 仿真 模拟 。 目 前 增长 的 应 
用 领域 主要 是 移动 系统 的 计算 机 动画 ， 特 别 是 用 
于 人 体 及 人 型 模型 方面 。 本 章 将 提出 机 器 人 机 构 
的 基本 动力 学 关系 ， 以 及 最 常见 计算 的 有 效 算 法 。 
算法 将 采用 简洁 的 空间 矢量 记 法 一 一 种 6 维 的 矢 
量 和 张 量 记 法 。 

本 章 针对 四 种 主要 的 计算 类 型 ， 提 出 相应 的 有 效 
低 阶 算法 : 

1) 逆向 动力 学 ， 即 通过 指定 的 机 器 人 轨迹 〈 位 
置 、 速 度 和 加 速度 ) ， 来 计算 关节 执行 器 的 力矩 / 力 。 

2) 正 向 动力 学 ， 即 用 指定 的 关节 执行 器 的 力 
矩 / 力 ， 来 确定 关节 加 速度 。 

3) 关节 空间 惯性 矩阵， 它 将 关节 加 速度 映射 到 
关节 力矩 / 力 。 

4) 操作 空间 惯性 矩阵 ， 它 在 操作 空间 (RÉF 
儿 空 间 ) 上 ， 将 任务 加 速度 映射 到 任务 力 上 。 

逆向 动力 学 用 于 前 馈 控 制 ， 正 向 动力 学 则 用 于 模 
拟 仿真 。 关 节 空 间 惯性 (质量 ) 矩阵 用 于 反馈 控制 
中 的 线性 化 动力 学 分 析 ， 同 时 也 是 正 向 动力 学 公式 的 
主要 部 分 。 操 作 空间 惯性 矩阵 主要 用 于 任务 控制 ， 或 
者 未 端 执行 器 的 位 控制 。 


2.1.1 空间 矢量 记 法 


2.2 节 提 出 了 空间 矢量 记 法 ， 以 清楚 而 简练 的 方 
式 来 表示 本 章 的 算法 。 这 种 记 法 最 初 由 Featherstone 
JR ^U, WRH 6 维 的 矢量 和 张 量 形式 ， 用 简练 的 
矢量 记 法 来 描述 刚体 的 速度 、 加 速度 、 惯 性 等 。2. 2 
节 中 解释 了 空间 矢量 和 算 子 的 含义 ， 并 通过 表格 形 
式 ， 详 细 说 明了 6 维 空间 中 这 些 量 和 算 子 与 标准 三 维 
空间 的 对 应 关系 ， 以 便 后 面 章 节 中 能 够 理解 这 些 算 
法 。 另 外 还 提供 了 能 有 效用 于 计算 实现 的 空间 算法 公 
式 。 作 者 力图 通过 空间 矢量 的 讨论 ,来 区 别 坐标 矢量 
和 用 它 表示 的 其 他 量 ， 并 阐述 空间 矢量 的 一 些 重要 
特性 。 


2.1.2 正则 方程 


2.3 节 中 提出 了 运动 体 动力 学 方程 的 两 种 基本 形 
式 : 关节 空间 公式 和 操作 空间 公式 。 关 节 空 间 公 式 中 


的 各 项 一 般 通 过 拉 格 并 日 (Lagrangian) 方法 推导 ， 
其 不 依赖 于 任何 参考 坐标 系 。 拉 格 朗 日 公式 用 于 描述 
关节 执行 右 力 和 机 构 运 动 之 间 的 关系 ， 以 及 系统 中 动 
能 和 势能 的 基本 关系 。 由 于 关节 空间 公式 具有 许多 节 
点 属性 ， 因 此 被 证 明 可 用 于 开发 控制 算法 。 此 外 ， 本 
节 还 提出 了 关节 空间 和 操作 空间 公式 中 相关 项 的 方 
程 ， 以 及 碰撞 模型 。 


2.1.3 ”刚体 系统 动力 学 模型 


本 章 中 的 算法 ， 需 要 基于 这 样 一 种 数据 结构 模 
型 ， 它 能 通过 其 输入 参数 来 描述 机 器 人 机 构 运 动 。 
2.4 节 提 供 了 这 种 模型 的 分 量 描述 方式 : 连接 图 、 连 
杆 几 何 参数 、 连 杆 惯 性 参数 ， 以 及 一 组 关节 模型 。 连 
接 性 描述 具有 一 般 性 ， 以 便 能 够 涵盖 运动 树 和 闭环 机 
构 。 运 动 树 和 用 于 闭环 机 构 的 生成 树 共用 通用 记 法 。 
为 了 描述 连 杆 和 关节 的 几何 学 ， 每 个 关节 上 采用 两 个 
关联 的 坐标 系 ， 分 别 放 在 前 蛙 李 和 后 继 李 上 。 后 继 坐 
标 系 可 定义 为 与 修正 Denavit Hartenberg “ 5E 3f 
容 “”1 ， 用 于 单 自由 度 关节 。 前 导 坐 标 系 可 定义 为 一 
种 便捷 方式 ， 用 于 描述 一 般 的 多 自由 度 关节 。 采 用 
Roberson- Schwertassek 通用 关节 模型 来 描述 连 杆 间 的 
连接 关系 。 作 为 示例 ， 本 节 给 出 了 仿 人 机 器 人 的 
连 杆 和 关节 编号 方式 ， 以 及 用 于 描述 连 杆 和 关节 的 坐 
标 系 配 置 。 该 示例 包括 浮 基 (底座 ) 和 回转 关节 、 
万 向 节 和 球 关节 。 


运动 树 


用 2.5 节 提 出 的 算法 ， 可 对 任意 机 器 人 机 构 (B 
运动 树 ) ， 计 算 逆 向 动力 学 、 正 向 动力 学 、 关 节 空 间 
惯性 矩阵 和 操作 空间 惯性 和 矩阵。 对 于 逆向 动力 学 问题 
XH O(n) 算法 ， 这 里 为 机 构 中 的 自由 度数 。 它 利 
用 问题 的 牛顿 - 欧 拉 公式 ， 并 基于 非常 有 效 的 递归 牛 
顿 - 欧 拉 算法 (RNEA)2249。 对 于 正 向 运动 学 问题 ， 
主要 采用 两 种 算法 : 一 种 是 Featherstone 提出 的 O(n) 
关节 体 算法 (ABA)?! ， 另 外 一 种 是 Walker 和 Orin 
提出 的 O(n?) 复合 刚体 算法 (CRBA)??, HFI 
算 关 节 空 间 惯 性 矩阵 (JSIM )。 该 矩阵 连同 采用 
RNEA 得 到 的 矢量 ， 提 供 运动 方程 的 系数 ， 用 于 对 加 
速度 的 直接 求解 下 。 操 作 空 间 惯性 矩阵 (OSIM) 
为 一 类 关节 体 惯量 ， 可 采用 如 下 两 种 算法 . 第 一 种 方 
法 是 采用 OSIM 的 基本 定义 ,第 二 种 方法 是 直接 的 
0(n) 算 法 ， 它 基于 正 向 运动 学 问题 的 有 效 解 。 为 方 
便 随时 查阅 ， 对 于 每 一 种 算法 的 输入 、 输 出 、 模 型 数 
据 及 伪 代 码 ， 都 总 结 在 表格 中 。 


2.1.4 
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2.1.5 运动 环 

上 述 算法 仅 适用 于 具有 运动 树 连接 性 、 无 分 支 
运动 链 的 机 构 。2.6 节 给 出 了 最 终 的 算法 公式 ， 可 
用 于 闭环 系统 的 正 向 动力 学 ， 其 中 包括 并 联机 器 人 
机 构 。 该 算法 对 闭环 系统 的 生成 树 运用 动力 学 方程 ， 
并 补充 闭环 约束 方程 。 本 节 简 要 介绍 了 用 于 求解 线 
性 系统 的 三 种 方法 ， 其 中 方法 二 对 于 站 >> 产 的 情况 
寺 别 有 用 ， 这 里 为 闭环 关节 的 约束 数 。 该 方法 还 
提出 可 对 生成 树 运 用 0(n) SHEU S, dem RA, 
提出 了 一 种 通过 将 变量 变换 到 单一 坐标 系 中 ， 来 计 
算 闭环 约束 的 有 效 算法 。 因 为 这 里 闭环 约束 方程 应 
用 在 加 速度 级 别 ， 所 以 采用 标准 Baumgarte 稳定 性 
条 件 * ， 防 止 闭 环 约束 中 产生 位 置 和 速度 误差 
累积 。 

本 章 最 后 一 节 进 行 了 了 总结， 提出 了 延伸 阅读 
的 建议 。 机 器 人 动力 学 领域 已 经 并 将 持续 成 为 内 
容 丰 富 的 研究 领域 ， 本 节 概 述 了 本 领域 已 取得 的 
主要 成 果 ， 以 及 最 稼 引述 的 相关 工作 。 由 于 篇 幅 
所 限 ， 不 能 全 方位 地 对 本 领域 内 的 众多 文献 加 以 
评述 。 


2.2 空间 矢量 记 法 


机 器 人 运动 学 问题 的 描述 ， 目 前 还 没有 一 个 统一 
的 数学 记 法 。 当 前 使 用 的 包括 3 维 矢量 、4 x4 和 矩阵 ， 
以 及 几 种 类 型 的 6 维 矢量 : 旋 量 、 对 偶 矢 量 、 李 代数 
元 素 和 空间 矢量 。 通 常 认为 6 维 矢量 记 法 最 好 ， 它 比 
3 维 矢量 记 法 紧凑 ， 又 比 4x4 ABTA, Alt 
我 们 在 本 章 中 全 部 采用 6 维 矢量 记 法 ， 并 运用 参考 文 
献 [2.8] 中 提供 的 空间 矢量 代数 学 方法 。 此 外 ， 
4x4 和 矩阵 介绍 见 参考 文献 [2.9]， 其 他 6 维 矢量 参 
阅 参 考 文献 【2. 10-12] 。 

在 本 书 中 ， 矢 量 通常 采用 粗 斜 体 字母 (WM: fov). 
然而 为 了 避免 命名 冲突 ， 我 们 将 采用 粗 正 体 字母 表示 
空间 矢量 (W: f、v)。 注 意 这 种 表示 仅 适 用 于 矢量 ， 
而 不 用 于 张 量 。 同 样 ， 仅 在 本 节 中 ， 坐 标 矢量 将 采用 
带 下 划 线 字母 ， 以 区 别 于 用 它们 表示 的 那些 矢量 
CASS v, vd v. v). 
运动 和 力 

出 于 数学 的 原因 ， 区 分 这 两 类 矢量 是 有 益 的 
即 描述 刚体 运动 的 矢量 和 作用 于 刚体 上 的 力 矢 量 。 
因此 我 们 将 运动 矢量 放 和 人 称 之 为 M' 的 矢量 空间 ， 
而 将 力 矢量 置 和 人 下" 空间 (这 里 上 标 表示 维 数 )。 运 


2.2.1 


动 矢量 用 于 描述 诸如 速度 、 加 速度 、 无 穷 小 位 移 ， 
以 及 运动 自由 的 方向 , 力 矢 量 描 述 力 、 动 量 、 接 触 
法 线 等 。 


2.2.2 HRS 
设 v 是 三 维 矢量 , Hv-(v, v, v) 是 笛 卡 儿 
坐标 矢量 ， 用 于 表示 在 正 交 基 |2, 9, 2] 中 的 zy， 


则 vy 和 ww 之 间 的 关系 用 公式 表示 为 
v 2X0, y 9, +20, 

这 一 思想 也 适用 于 空间 矢量 ， 例 外 的 情况 是 采用 
Plücker 坐标 替代 笛 卡 儿 坐 标 ， 并 用 Plücker 基 矢 量 替 
代 正 交 基 。 

Plücker 坐标 在 1.2.6 节 中 已 做 过 介绍 ， 基 矢量 
表示 如 图 2. 1 所 示 。 图 中 总 共有 12 个 基 矢 量 : 6 个 
运动 矢量 和 6 个 力 矢量 。 给 定 的 一 个 笛 卡 儿 坐 标 系 
Oxyz, Plücker 基 矢 量 定 义 如 下 : 3 个 关于 有 向 直线 
Ox, Oy, Oz 的 单位 转角 ， 表 示 为 do. . do, . ds; 
3 个 x、y、z 方 向 的 单位 平移 ,表示 为 d,、d,、d.; 
3 个 分 别 关 于 x、y、z 方 向 的 单位 力 偶 ， 表 示 为 eL. 
e, e; 3 个 沿 Ox, Oy, Oz 方向 的 单位 力 ， 表 示 为 


Cons Cay. C0:0 


Æ 2.1 Plücker ERE 
a) 运动 矢量 b) JRE 


2.2.3 空间 速度 和 力 


给 定 任意 一 点 0O， 刚 体 的 速度 可 通过 一 对 三 维 矢 
E co 和 vv, 描述 ，w Ally, 分别 是 刚体 (构件) 上 当前 
位 于 0 点 的 一 个 固定 点 的 角速度 和 线 速度 。 注 意 v。 
不 是 0 点 本 身 的 线 速度 ， 而 是 刚体 上 正好 与 0 点 重 
合 的 、 刚 体 固定 点 的 瞬时 速度 。 

对 同一 刚体 ， 其 速度 也 可 描述 为 一 个 空间 运动 矢 
i, ve MÓ, 为 了 通过 w 和 vw 得 到 v， 我 们 首先 介绍 
笛 卡 儿 坐标 系 Oxyz, HRAN O 点 。 此 构 型 对 o 和 
voXE X. Y f -RJLAS ERAS, text v 定义 了 Plücker 坐标 
系 ， 给 定 这 些 坐标 系 ， 可 以 表示 为 
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v=d,,o, 


+ d,,o, + doo, +d Vo, + d,v,, + dvo, 

(2.1) 
这 里 w,，…, vv. 是 笛 卡 儿 坐 标 系 Oxyz P eo 和 vo hA 
标 。 这 样 ，v 的 Plücker 坐标 即 为 w Allo, AY tF JLA 
bk. Æ Oxyz 中 用 坐标 矢量 表示 的 v 可 以 写成 : 


TK > 


O, 
Qo 
vo=| i [= | | (2.2) 
Yo 
式 中 最 右边 项 为 Pliicker iden 的 缩写 记 法 。 
类 似 地 可 以 定义 空间 力 : 给 定 任意 点 0， 作 用 在 


刚体 上 的 力 系 ， ncm d 0 点 作用 线 的 一 个 
集中 力 f， 再 加 上 一 个 纯 力 偶 n,， 它 是 力 系 关于 0 点 
的 力矩 。 这 样 ， 用 两 个 矢量 f 和 n, 描 述 作 用 于 刚体 


上 的 力 系 ， 这 与 用 w 和 wv, 描述 速度 相 类 似 。 这 个 力 
也 可 用 一 个 空间 力 矢 量 来 表述 ， 即 fe F"， 引 入 与 前 


面 一 样 的 坐标 系 Oxyz， 可 得 
f-e,n, +e,no, +e:nos+eo f, t ey f, + e, f. 
(2.3) 
SUP, no, 0, /为 0wz 中 的 和 no 的 笛 卡 儿 坐 标 。 
在 Oxyz 中 用 坐标 矢量 表示 的 f 为 


Nox m 
no 

f=] : |= | f | 
"A H 


即 为 Oxyz "P f fJ Plücker 坐标 ， 上 式 最 右边 
Plücker 坐标 列 的 简化 记 法 。 


2.2.4 加 法 和 数 乘 


在 加 法 和 数 乘 中 ， 空 间 矢量 表现 为 显 式 方式 。 例 
如 ， 如 果 力 fi 和 都 作用 于 刚体 ， 则 它们 的 合力 为 
f, +f,。 又 如 两 个 不 同 物体 分 别 具 有 速度 v, 和 v, 
第 二 个 刚体 相对 于 第 一 刚体 的 速度 为 w -vo WR f 
表示 空间 上 IN 的 力 沿 着 某 一 直线 作用 ， 则 af 表示 
aN 的 力作 用 于 同一 直线 上 。 
2.2.5 数量 积 

数量 积 定义 在 两 个 任意 的 空间 矢量 上 ， 假 设 其 中 一 
个 是 运动 ， 男 外 一 个 为 力 ， 给 定 任意 meM, feF", 
数量 积 可 写成 m fRA f m 的 形式 。 这 表示 作用 
于 刚体 的 力 f 使 刚体 运动 m 所 做 的 功 , f£ m - m 和 
ff 的 表达 式 则 无 定义 。 如 果 m 和 了 为 同一 坐标 系 
下 ， 用 坐标 矢量 表示 的 m 和 f， 则 有 


(2.4) 


的 项 为 


m-:f-m'f (2.5) 
2.2.6 坐标 变换 
运动 矢量 和 力 矢 量 服从 不 同 的 变换 规则 : 设 4 和 


B 为 两 个 坐标 构 型 ， 每 个 定义 一 个 同名 坐标 系 ; 
m,, m,, f,, f, LE i i 
的 空间 矢量 , me M^, fe F*， 则 变换 规则 为 
m; = Xm (2.6) 
f,-"Xjf, (2.7) 
式 中 , ^x AP X^ 分 别 为 对 运动 和 力 矢 量 从 4 S B 的 
坐标 变换 矩阵 。 这 些 矩 阵 通过 恒等式 相关 联 
aue cj) eS (2.8) 
设 构 型 4 相对 于 构 型 B 的 位 置 和 姿态 通过 一 个 
MERE” p 4 和 一 个 4x4 AYE FE BPR, (UL 1.2 
节 ) RHE, W^ X. 


1 FR, 0 
ela ) 3 A 
Pa ^/ (29) 


S( "Pa ) "R, "R, 


ix ^R, 0 1 0 sah 
^60 ^R, eens "| jM 


SC p) 为 斜 对 角 阵 ， 对 于 任意 的 3 维 矢量 "， 满 
) 


m 


足 S(p )v =p xv， 用 公式 表示 为 
0 -p p, 
S(p) =| P 0 -p (2.11) 
-p p, 0 


2.2.7 矢量 积 


空间 矢量 的 矢量 积 (AE) 有 两 种 定义 ， 第 一 
种 是 由 两 个 运动 矢量 变量 得 到 一 个 运动 矢量 结果 ， 月 
公式 表示 为 


m, m, 
mxm,=| Ix| 
Myo Myo 


| m, x m, 
m, XM +Mio XM, 


运动 矢量 为 左 变量 ， 力 矢量 为 右 变 量 ， 


是 
是 一 个 力 矢量 ， 即 


mx fotmoxf 
= | (2.13) 


a 


(2.12) 


mxf 


这 些 矢 量 积 也 可 ! " 现在 微分 公式 中 。 
类 似 于 式 (2.11), ， 也 可 定义 这 样 一 个 矢量 积 算 
子 ， 形 式 如 下 : 


S(m) 0 
SED ibo s) V 
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在 这 种 情况 下 如 果 是 位 置 矢量 ， 它 表示 0 点 处 刚体 固定 点 相 
fii eens = Cai, an (2.15)  XFFf TS 则 
而 vo =F 
可 以 看 出 ， 这 里 S(m) 映射 运动 矢量 到 运 -— AR 
m" v, = F -WXv 
d ! I 0 0 
ES IOS an) AO NS 两 种 加 速度 的 实际 差别 在 于 ， 空 间 加 速度 使 用 起 
2.2.8 微分 来 更 方便 。 例 如 : 如 果 构 件 B, 和 B, 分 别 具 有 速度 v， 
o, Hv Æ B XF B HME, N 
esc i e LAT. fll v, Dee 则 
x -Óx) -s(x B av = 
s(x) = lms (s+ sl (9,17) 其 空间 加 速度 间 的 关系 ， 只 要 对 上 述 速 度 公式 求 
steht, s 为 任意 空间 矢量 。 导 数 就 是 同类 空间 矢量 。 微分 即 可 得 到 


(运动 或 力 ) 求 其 微分 。 
在 动 坐标 系 中 ， 对 空间 矢量 求 微分 的 公式 为 


Ch 
dh di TA 


式 中 , s 是 任意 空间 矢量 ; = 表示 s 对 时 间 求 导 ; 


(2.18) 


ARDER (F ;) 是 4 MAR ARR AS ; s, 是 s 在 


4 坐标 系 中 的 坐标 矢量 ; ds,/dt Æ s, 对 时 间 的 导数 
(这 里 对 各 分 量 求 导 ， 因 为 s, 是 坐标 矢量 ) ; 


vy ÆA 


坐标 系 下 的 速度 。 
对 于 运动 体 的 空间 矢量 ， 其 对 时 间 的 导数 是 变化 
的 ， 给 定 如 下 : 
S s-vxs (2.19) 
式 中 , vÆ s 的 速度 量 。 此 公式 适用 于 自身 的 微分 量 


没有 变化 ， 而 它 附 在 运动 刚体 上 的 情况 (如 关节 轴 
矢量 )。 
2.2.9 加 速度 


空间 加 速度 定义 为 空间 速度 的 变化 率 。 然 而 这 里 
空间 加 速度 的 含义 不 同 于 传统 教科 书 上 的 刚体 加 速度 
定义 (我 们 称 之 为 经 典 加 速度 )， 其 本 质 差 别 概括 


如 下 : 
e w 
a=| 5w] (2.20) 
E Vo E vo 


RP, a 是 空间 加 速度 ; a' 是 经 典 加 速度 ;2 是 将 0 


点 固定 在 空间 上 时 对 w 的 导数 ; "4 是 将 0 点 固定 于 
构件 上 时 对 wo 的 导数 ， 两 种 加 速度 的 关系 为 


(2.21) 


d 
ETA V =V, + V,,,) >a, =a, * a, 


可 见 室 间 加 速度 与 速度 类 似 ， o 


不 用 考虑 科 氏 ( Coriolis) 项 或 离心 项 ， 是 在 公式 
上 对 经 典 加 速度 的 一 个 重要 改进 ， 见 参考 文献 


[2.2, 13, 14], 
2.2.10 空间 动量 

设 刚 体质 量 为 m， 质 心 为 C， 且 关于 C 点 的 转 
动 惯量 为 1” (如 图 2.2 所 示 )。 如 果 构 件 运动 的 空 
BEREN ve = (w' vs) "， 则 其 线性 动量 为 h = mow， 
[ET fü zl Og ho =1™w。 它 关于 某 一 点 0 的 动量 矩 
为 hs =hs+c xh， 这 里 c=0C。 我 们 将 这 些 矢量 组 


合成 一 个 空间 动量 矢量 的 形式 ， 表 示 如 下 : 
HC) 
he=| |=} 一 (2. 23) 
i h eG 
H 
is 
ho = so (224) 
EU 0 1 
空间 动量 为 力 矢 量 及 其 相应 的 变换 。 
质量 :m 
转动 惯量 :7" 动量 
线 h-mu. 
E 角 hc I9 


图 2.2 空间 动量 
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— I, =1, +1, (2,33) 
221 SAME 这 个 简单 的 方程 代替 了 传统 三 维 矢量 方法 中 的 三 
刚体 的 空间 动量 是 其 空间 惯量 和 速度 的 积 个 方程 : 一 个 计算 组 合 质量 ， 一 个 计算 复合 质心 ， 一 
h-Iv (225) 个 计算 复合 转动 惯量 。 如 果 刚 体 具有 惯量 I 并 以 速度 
这 里 了 是 空间 惯量 , 在 C 点 用 Plücker 坐标 表示 ， vv 运动 ， 其 动能 为 

可 得 (RE (2.34) 

hy = Lev (2.26) 2 
其 中 如 果 刚 体 B 是 大 系统 的 一 部 分 ， 则 可 对 B 定义 
pea 一 个 表 观 惯性 矩阵 ， 用 于 描述 在 考虑 系统 中 其 他 构件 
iss il (2.27) 的 影响 时 ， 作 用 于 8B 上 的 力 与 加 速度 之 间 的 关系 ， 


这 就 是 质心 处 刚体 空间 惯量 的 一 般 公 式 。 而 对 另 
外 一 点 0 的 惯量 表达 式 ， 由 式 (2.21), X (2.26) 
TX (2. 27)， 求解 如 下 : 


h, = : SM) fe 0 z 

7 0 1 0 ml 
i 1 bd I" 0 1 0 
(0 1 0 mlAS( 1/7 


I +mS(c)S(c)" 2 
= Vo 


mS(c)* 
| (2. 28) 


ml 
而 已 有 hy =Tovo 故 

[ *mS(c)S(c)' mS(c) 

7o = E i d 


mS(c)" ml 
这 一 方程 也 可 写成 
| I, pr 
I= : - (2.29) 
mS(c)! ml 
其 中 
I, =I" +mS(c)S(Cc) (2.30) 


为 关于 点 0 的 刚体 转动 惯量 。 
空间 惯性 矩阵 为 对 称 正定 和 矩阵。 一 般 情 况 下 ， 
确定 一 个 空间 惯量 需要 21 个 数 (如 : 对 于 关节 体 或 
者 操作 空间 惯量 ) ;而 刚体 惯量 只 需要 10 个 参数 : 
质量 、 质 心 坐标 ， 以 及 7” (或 1,) 的 6 个 独立 
元 素 。 
空间 惯量 的 变换 规则 为 
I, -?XiLX, (2.31) 
UH, 4 和 B 为 任意 两 个 坐标 系 。 在 实际 运用 中 ， 经 常 
需要 只 给 定 * 对 ,， 通 过 了 来 计算 IT， 这 一 变换 的 公式 为 
I, - CX,)' EX, (2.32) 
如 果 两 个 构件 ,分 别 具 有 惯量 I 和 7,， 将 其 刚性 
连接 成 一 个 复合 体 ， 则 复合 体 惯量 工 , 等 于 原来 各 部 
分 惯量 之 和 : 


这 个 量 称 作 关节 体 惯量 。 如 果 B 正好 是 机 器 人 末端 
执行 器 ， 则 其 表 观 惯量 称 为 操作 空间 惯量 


o 


2.2.12 ”运动 方程 
空间 运动 方程 表明 ， 作 用 于 刚体 上 的 力 等 于 其 动 
量 的 变化 率 : 
tv) -Ias İv 


可 以 证 明 ， 表 达 式 Iv 的 值 为 (v x 1v) 9*7, 

故 运 动 方程 可 写 为 
f=Ia+vxIy (2.35) 
这 一 单个 方程 合并 了 刚体 运动 的 牛顿 方程 和 欧 拉 
方程 。 为 了 验证 这 一 点 ， 我 们 复述 如 下 ， 构件 质心 位 
ERIL (2.35), FZM (2.14), 


(2.16) 及 式 (2.22), Ale 
n, I" e 
m9, 


7 n a o S(@)" S(w)' 
Lo mM) (Go) lo Sw)" 


f 


2.2.13 计算 实现 


在 计算 机 上 实现 空间 矢量 算法 的 最 简单 方法 ， 就 
是 首先 利用 现 有 的 矩阵 运算 工具 ， 如 MATLAB® , 
并 按照 以 下 步骤 编写 程序 (或 从 网 上 下 载 ) : 

1) 根据 式 (2.14) ， 通 过 m 求 SCmy)。 

2) 根据 式 (2.9), 通过 R Mpok X. 

3) 根据 式 (2.28) , 通过 m、c MIR I. 

其 他 空间 算 述 运算 ， 都 可 以 使 用 标准 的 矩阵 运 允 
程序 ， 另外 一 些 附加 程序 也 可 以 添加 到 列表 中 ， 如 : 
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1) 用 于 通过 各 种 其 他 转动 表示 式 ， RIESE RAY 
程序 。 
2) 用 于 空间 和 4 x4 矩阵 量 之 间 转 换 的 程序 。 
每 着 考虑 工作 效率 比 计算 效率 更 为 重要 时 ， 此 方 

法 便 值得 推荐 。 


如 果 需 要 更 高 的 效率 ， 那么 就 需要 使 用 一 个 更 精 
细 的 空间 运算 库 ， 包 括 : 

1) 对 每 类 空间 量 定义 专门 的 数据 结构 。 

2) 借助 效率 公式 ， 提 供 一 套 计算 程序 ， 每 个 程 
序 实现 一 种 空间 算术 运算 。 

表 2. 1 中 列举 了 一 些 合适 的 数据 结构 和 有 效 的 计 
算 公 式 。 可 以 看 到 ， 用 于 刚体 惯量 和 Plicker 变换 的 
建议 数据 结构 ， 包 含 的 个 数 仅 为 6 x6 FR RR B = 
分 之 一 。 表 2. 1 中 列 出 的 效率 算法 公式 ， 比 通常 使 用 
的 6x6 和 6 x1 矩阵 算法 计算 量 节省 1.5 ~6 倍 。 更 
多 的 效率 公式 可 参阅 参考 文献 [2. 16] 。 


表 2.1 空间 矢量 记 法 


机 器 人 学 基础 
( 续 ) 
刚体 质心 相对 于 0 点 的 位 置 
AKEHE h= me， 也 可 以 表示 为 线性 
动量 
Io 关于 质心 的 转动 惯量 
i 关于 0 点 的 转动 惯量 
ER, 从 坐标 系 4 到 有 的 正 交 旋 转 矩 阵 变换 
| B 坐标 系 原点 相对 于 4 坐标 系 原点 的 位 置 ， 
P5 4 坐标 系 表示 
方程 


ll 


| 
«(E C) 


空间 量 i | I id 
v 刚体 速度 S(h)" ml 
a 刚体 的 空间 加 速度 (a= v) «(Fesser ene) 
a’ 6 维 矢量 表示 的 刚体 经 典 加 速度 mS(c)" nl 
f 作用 于 刚体 的 力 w d "e 
I 刚体 惯量 d NM | NN a] 
X 运动 矢量 的 Plücker 坐标 变换 
x 力 矢量 的 Plicker 坐标 变换 (X^ =X") iA CU dli dal 
?X, 从 4 坐标 到 B 坐标 的 Plücker 变换 wxm S(@) 0 m 
m 通用 运动 矢量 (M6 的 任意 元 素 ) igo Eo sto Jo.) 
3 维 量 
EEEUTT: — uu nd 上 人 | 的 
wxf 0 S(o)/Xf 
; 0 点 处 刚体 固定 点 ， 相 对 于 空间 任意 固定 
点 的 位 置 紧凑 计算 表示 法 
e 刚体 角速度 数学 对 象 RO Æ | 计算 表示 法 | R 度 
vo 0 点 处 刚体 固定 点 的 线 速度 (wo = 站) m 
"EE 刚体 角 加 速度 " LM S ss 
by 0 点 固定 于 空间 上 时 ,wo 的 导数 " 
0 点 固定 于 刚体 上 时 ， wo 的 导数 ; 0 点 处 (7) AMEND | 
OO | MREZI i= F) - 
- | m d 6x6 — (m; h; P) | 15349 
f 作用 于 刚体 的 力 ， 或 力 系 的 合力 S(h)! m 
n, 力 或 力 系 对 0 点 的 抵 "E 
m 刚体 质量 nr 4 one SN = 
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( 续 ) 
有 效 空 间 算术 公式 
表 达 式 计 算 值 
Xv (Ro; R(v; -pxo)) 
Xx'tf (R(no -p xf); Rf) 
x^ (R', -Rp) 
X^v (R'o; R'v, +p xR'o@) 
(xX?) If (Rino +p xR" f, R" f) 
X,X, (GR; p; +R3P1) 
1, +L, (m, +m; h, +h); I +L) 
Iv (la * h xvo; mv, -hxeo) 
ides (m PER +mp; R'IR - 
S(p)S(R"h) - S(R'h + mp)S(p)) 


TE: XIX 的 含义 参见 式 (2.32), 


2.2.14 


空间 矢量 为 6 维 矢量 ， 它 合并 了 刚体 运动 的 线 度 
和 角度 两 个 方面 ， 这 使 得 紧凑 记 法 非常 适合 用 于 描述 
动力 学 算法 。 为 避免 名 称 上 的 冲突 ， 我 们 采用 粗 正体 
字母 表示 空间 矢量 ， 而 张 量 仍然 使 用 斜体 表示 。 在 接 
下 来 的 几 节 中 ， 将 采用 正体 字母 表示 空间 矢量 ， 以 及 
相 联 的 其 他 矢量 ， 如 qo 

表 2.1 简要 列 出 了 本 节 介 绍 的 各 种 空间 量 和 
算 子 ， 以 及 按照 3 维 量 和 算 子 定义 的 公式 。 本 节 
还 提出 了 数据 结构 和 效率 公式 ， 用 于 空间 算法 的 
计算 实现 。 此 表 结 合 表 1.5 0261.6, 说 明 如 何 计 
算 各 种 关节 类 型 的 姿态 、 位 置 和 空间 速度 。 注 意 
在 读 取 表 2. 1 øF, PR) 和 “ps 分 别 对 应 于 第 1 章 表 中 
HJIR A/D, « 


小 结 


2.3 正则 方程 


机 器 人 机 构 的 运动 方程 ， 通 常 表示 为 以 下 两 种 正 
则 形式 : 


1) 关节 空间 公式 : 


H(q)q-*C(q.q)q*T.(q)-T (2.37) 
2) 操作 空间 公式 : 
A(x) v +u(x,v) +p(x) =f (2. 38) 


IÈ (2.37) 和 式 (2.38) 给 出 了 显 式 形式 的 函 
数 关 系 : 五 是 q 的 函数 ;A 是 x 的 函数 等 。 一旦 明白 
了 这 些 关系 ， 表 述 时 就 可 以 省 略 。 在 式 (2.38) 中 ， 


x 为 操作 空间 坐标 中 的 矢量 ， 其 中 v 和 f 为 空间 矢量 ， 
分 别 表示 末端 执行 器 的 速度 和 作用 于 其 上 的 外 力 。 如 
果 机 器 人 是 匈 余 的 ， 则 这 些 方 程 的 系数 必须 定义 为 q 
和 q 的 函数 ， 而 不 是 x 和 v 的 函数 。 

这 两 个 方程 连同 式 (2.37) 的 拉 格 朗 日 描述 ， 
以 及 碰撞 问题 的 运动 方程 ,在 下 面 会 作 进 一 步 
解释 。 


2.3.1 关节 空间 公式 


fq. qa. q 和 FT 分 别 表 示 关 节 的 位 置 、 速 
度 、 加 速度 和 力 变 量 的 n 维 矢量 ,这 里 nn 是 机 右 人 
机 构 的 运动 自由 度数 ; HD nxn BOSE PRAE XE AR 
阵 ， 称 为 广义 (或 关节 空间 ) 惯性 矩阵 (JSTM); 
C Æ n xn EE E Cq 为 科 氏 矢量 和 离心 项 ( BE 
称 为 速度 积 项 ) ; Ts 为 重力 项 的 矢量 。 如 果 需 要 考 
虑 其 他 动力 学 影响 (如 黏 性 摩擦 ) ， 还 可 以 在 此 方 
程 中 加 进 更 多 项 。 在 末端 执行 器 上 ， 施 加 于 机 构 
的 作用 力 f 的 影响 ,可 以 考虑 为 ,在 式 (2.37) 
的 右边 加 上 Jf 项 ， 这 里 J 为 末端 执行 器 的 雅克 比 
和 矩阵 ( 见 1.8 节 )。 

q 为 机 构 构 型 空间 上 一 点 的 坐标 ， 如 果 机 构 为 一 
运动 树 ( 见 2.4 节 )， 则 gq 包含 机 构 中 的 每 一 个 关节 
变量 ， 和 否则 只 包含 其 中 独立 的 子 集 。dq 的 元 素 为 广义 
MERR, EERE, q, q 和 T 的 元 素 分 别 为 广义 速度 、 
加 速度 和 力 。 


2.3.2 拉 格 朗 日 公式 


X (2.37) 中 各 项 的 推导 方法 很 多 ， 在 机 器 人 
学 中 最 常用 的 有 牛顿 - 欧 拉 公式 和 拉 格 朗 日 公式 。 前 
者 对 于 刚体 直接 用 牛顿 - 欧 拉 方程 ， 它 包含 在 式 
(2.35) 的 空间 运动 方程 中 。 这 个 公式 特别 适合 开 
发 动力 学 计算 中 的 有 效 递 归 算法 ， 见 2.5 T 
2.6 Wi. 

拉 格 朗 日 公式 通过 机 絮 人 机 构 的 拉 格 朗 日 函数 进 
行 计算 : 


L-T-U (2.39) 
AP, TAMU ASL A SUE ae, SURE F 
式 给 出 : 


1 


T=-q'Hq (2. 40) 
则 对 每 个 广义 坐标 ， 运 用 拉 格 朗 日 方程 ， 动 力学 方程 
可 展开 为 

d ðL aL 

oa (2.41) 
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$a d $ $c +m =% (2.42) Tai (2.51) 

j=l j=l k=1 = (JHJ! 2.52 

其 显示 为 速度 乘积 项 的 结构 ，C， 称 为 第 一 类 型 的 Vas 
Christoffel 符号 ， 给 定 如 下 : M -A(H Cd - Jq) (2.53) 
1 (aH, oH, oH, p = AJH Tt: (2.54) 

Ca = (a Pig xd set 这 些 方程 都 假定 m<n (m 是 操作 空间 坐标 的 维 


其 仅 为 未 知 变量 qu PER, 式 (2.37) 中 CC 的 元 素 
定义 为 


(2.44) 
还 有 其 他 可 能 的 定 


C; = Y Cad, 
k=l 
然而 这 里 对 C 的 定义 并 不 唯一 ， 
义 形式 。 
通过 式 (2.44) 中 C WE, EE N 可 给 
如 下 : 


N(q, 4) - H(q) -2C(q,q) (2.45) 
VdÉ—4 BO BOBEEAL UT, AEE n x 1 维 矢量 
a 有 

a'N(q,q)a=0 (2. 46) 
这 一 性 质 在 控制 中 非常 有 用 ， 特 别 是 当 aw = q BI, A 
q'N(q.q)q-0 (2.47) 
由 能 量 守恒 定律 可 以 证 明 ， 对 于 任意 选 定 的 和 矩阵 

C, IÈ (2.47) SL 


2.3.3 操作 空间 公式 


TEX (2.38) P, x 为 操作 空间 坐标 的 6 维 矢 
量 ， 它 给 出 了 机 器 人 末端 执行 器 的 位 置 和 姿态 ; v 是 
末端 执行 器 的 速度 ; f 为 外 加 的 力 。 x Rao I e 
JLE, HEMT Ea oR, AAS vA 
微分 关系 


x -E(x)v (2.48) 

A 为 操作 空间 惯性 矩阵 ， 是 末端 执行 器 的 表 观 惯 
性 ， 它 考虑 到 了 机 器 人 机 构 其 余部 分 的 影响 (BU 
它 为 关节 体 惯 性 ) ; po Ap 分 别 为 速度 积 矢 量 和 重 
力 矢 量 。 

操作 空间 (也 称 任务 空间 ) 中 ， 能 发 出 和 执行 
高 级 别 的 运动 和 力 指令 ， 因 此 其 公式 在 运动 和 力 控制 
Ph 特别 有 价值 ( 见 6.2 节 和 7.2 节 )。 式 (2.38) 除 
了 用 于 6 维 空间 外 ， 也 可 以 推广 到 操作 空间 中 ， 并 能 
应 用 到 一 个 以 上 的 末端 执行 器 的 组 合 运动 中 "|。 

式 (2.37) 和 式 (2.38) 中 的 项 和 下 列 公 式 
有 关 : 


n 


v=Jq (2.49) 


数 ) ， 且 雅 可 比 和 矩阵 J 为 满 秩 。 更 多 详情 参见 参考 文 
BK [2.20]. 


碰撞 模型 


如 果 机 器 人 运行 中 碰撞 了 外 界 刚体 ， 那 么 接触 瞬 
间 产 生 冲 击 力 ， 就 会 引起 机 器 人 速度 的 阶 跃 变化 。 假 
设 未 端 执行 器 和 外 界 刚 体 发 生 了 碰撞 ， 且 瞬间 冲击 力 
作用 在 末端 执行 咽 上 ， 这 个 冲击 力 使 得 末端 执行 絮 的 
速度 产生 了 Av 的 阶 路 ， 两 者 通过 碰撞 运动 的 操作 空 
间 方 程 相关 联 * 


2.3.4 


Adv =f (2.55) 
在 关节 空间 中 ， 机 器 人 机 构 的 碰撞 方程 为 
H^q =T (2.56) 


式 中 , TA Ag 分 别 表示 关节 空间 中 的 冲 量 和 速度 变 
化 。 在 涉及 机 器 人 末端 执行 器 的 碰撞 情况 下 ， 有 
JP (2. 57) 


及 

Av=JAd 
根据 式 (2.51) 和 式 (2.49), 
(2.57) 中 可 得 到 


(2. 58) 
从 式 (2.55) ~ 式 


Ad =JAv (2.59) 
st, J 是 J 的 惯性 加 权 伪 逆 ， 给 定 如 下 : 
J-H^J'A (2. 60) 


JARRAI METT LEHE AE B 2) SR P R AE PET, 
uu 现在 式 (2.53) 和 式 (2.54) 中 的 表达 式 
CAEFJ'. DO H AA 均 为 对 称 阵 。 尽 管 文中 
ENS LR PLE 
常规 ( 非 碰撞 ) 动力 学 方程 中 。 


2.4 刚体 系统 动力 学 模型 


机 器 人 机 构 的 基本 刚体 动力 学 模型 ， 由 四 部 分 组 
成 : 连接 图 、 连 杆 和 关节 几何 参数 、 连 杆 惯性 参数 ， 
以 及 一 组 关节 模型 。 对 这 个 模型 ， 可 以 加 上 各 种 产生 
TAC, ASE, BEAR, KWER, PTT ae SK 
动 顺 等 。 特 别 是 对 执行 器 和 驱动 器 ， 其 具有 复杂 的 动 
力学 模型 。 在 关节 轴承 和 连 杆 上 ， 可 添加 额外 的 运动 
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自由 度 来 模拟 弹性 问题 (第 13 章 )。 本 节 只 描述 基 
本 模型 ， 关 于 这 一 主题 的 更 多 内 容 ， 可 以 在 一 些 书 中 
找到 ， 见 参考 文献 [2.3, 8, 22]. 


连接 性 


连接 图 是 一 个 无 向 图 ， 其 中 每 个 节点 代表 一 个 刚 
体 ， 每 条 弧 线 表示 一 个 关节 。 该 图 必须 连接 ， 有 日 有 一 
个 节点 代表 固定 基 或 参照 系 。 如 果 图 表示 的 是 移动 机 
器 人 【( 即 机 器 人 没有 连接 到 固定 基 上 )， 则 需要 在 固 
定 基 和 移动 机 器 人 任意 一 个 构件 间 ， 引 入 一 个 虚拟 的 
六 自由 度 关 节 ， 选 定 的 构件 称 为 浮 基 。 如 果 一 张 图 上 
表示 的 是 多 个 移动 机 器 人 的 集合 ， 则 每 个 机 器 人 都 有 
自己 的 浮 基 ， 每 个 浮 基 都 有 自己 的 六 自由 度 关 节 。 注 
意 这 里 的 六 自由 度 关节 ， 没 有 在 两 个 连接 构件 间 施 加 
约束 ， 因 此 它 的 引入 只 是 改变 了 图 的 连接 性 ， 而 没有 
改变 系统 的 物理 属性 。 

在 图 论 术语 中 ， 环 表示 一 个 与 自身 节点 相连 的 
弧 ， 回 路 表示 一 条 闭合 路 径 且 不 能 穿越 任意 弧 一 次 以 
上 。 在 机 器 人 机 构 的 连接 图 中 ， 环 是 不 允许 的 ， 回 路 
称 为 运动 环 。 包含 运动 环 的 机 构 称 为 闭环 机 构 ， 不 包 
含 运动 环 的 机 构 称 为 开 环 机 构 或 运动 树 。 每 个 闭环 机 
构 有 一 个 生成 树 ， 其 定义 为 开 环 机 构 ， 不 在 生成 树 上 
的 关节 称 为 闭环 关节 ， 树 上 的 关节 称 为 树 关 节 。 

固定 基 用 于 运动 树 的 根 节点 ， 也 是 闭环 机 构 任 
意 生成 树 的 根 节点 。 如 果 至 少 一 个 节点 具有 两 个 子 
节点 ， 运 动 树 就 称 为 可 分 支 的 ， 否 则 称 为 不 可 分 支 
的 。 无 分 支 的 运动 树 称 为 运动 链 ， 有 分 支 的 运动 树 
称 为 分 支 运 动 链 。 典 型 的 工业 机 器 人 手臂 ， 没 有 抓 
手 时 是 一 个 运动 链 ， 而 仿 人 机 器 人 是 带 有 浮 基 的 运 
动 树 。 

在 一 个 包含 N; 个 运动 构件 和 Nj) 个 关节 的 系统 
中 ， 这 里 NN 包括 前 面 提 到 的 六 自由 度 关节 。 运 动 构 
件 和 关节 编号 规则 如 下 : 首先 固定 基 的 编号 为 构件 
0(B0) ， 其 他 构件 按 一 定 次 序 从 1 到 Ns 编 号 ， 使 子 构 
件 编号 大 于 其 父 编号 。 如 果 系 统 包含 运动 环 ， 则 必须 
首先 选择 一 个 生成 树 ， 再 进行 编号 选择 ， 因 为 父 构件 
的 识别 要 由 生成 树 确 定 。 这 种 编号 风格 称 为 规则 编号 
方案 。 

完成 构件 的 编号 后 ， 就 要 对 树 关 节 从 1 到 WN, 进 
行 编号 ， 以 便 通过 关节 i 连接 构件 i 到 其 父 构 件 上 。 
如 果 有 闭环 关节 ， 则 以 任 一 次 序 从 N; +1 到 Ni 进行 
编号 。 每 个 闭环 关节 上 闭合 一 个 独立 运动 环 ， 环 编号 
从 1 到 N OXE N, =N, - Ne 为 独立 的 环 数 ) ， 以 便 
环 ! 由 关节 有 = Ns +1 来 闭合 。 在 图 中 运动 环 ! 是 唯一 
回路 ， 且 穿越 关节 k， 但 不 穿越 其 他 任何 闭环 关节 。 


2.4.1 


对 于 无 分 支 的 运动 树 ， 这 些 规则 产生 唯一 的 编号 
方式 ,构件 的 编号 为 从 基底 到 顶部 进行 连续 单一 编 
号 ， 关 节 要 这 样 进行 编号 : 关节 i 连接 构件 i 和 i -1。 
在 其 他 情况 下 ， 规 则 编号 均 不 唯一 。 

尽管 连接 图 是 无 向 的 ， 但 有 必要 对 每 个 关节 指派 
一 个 方向 ， 用 于 定义 关节 速度 和 力 ， 这 对 于 树 关 节 和 
闭环 关节 都 是 必需 的 。 具 体 地 讲 ， 关 节 用 于 连接 一 个 
构件 到 另 一 个 构件 ,我们 可 以 将 关节 i 连接 的 两 个 构 
件 ， 分 别称 为 前 导 构 件 p(i) 和 后 继 构件 *(i) ， 则 关 
节 速 度 定义 为 后 继 件 相对 于 前 导 构 件 的 速度 ， 关 节 力 
定义 为 作用 于 后 继 构 件 的 力 。 对 于 所 有 树 关节 ， 标 准 
做 法 〈 但 非 必需 ) 是 从 父 构件 向 子 件 连 接 。 

运动 树 或 者 闭环 机 构 生 成 树 的 连接 性 ， 可 通过 其 
父 构 件数 的 Ws 个 元 素数 组 来 描述 ， 其 中 第 ;个 元 素 
pCi) 为 构件 i 的 父 构 件 。 注 意 对 于 构件 i 的 父 构件 
p(i) ， 也 是 关节 i 的 前 导 构 件 p(i) ， 因 而 是 通用 的 记 
法 。 许 多 算法 中 借助 p(i) «i 的 特性 来 按 正 确 次 序 完 
成 计算 。 对 于 子 构件 i， 所 有 构件 编号 的 集合 c(i), 
也 在 许多 递归 算法 中 有 用 。 

对 于 运动 环 的 连接 性 数据 描述 ， 可 采用 多 种 
方式 。 能 方便 用 于 递归 算法 中 的 表述 ， 它 包括 如 
下 约定 : 闭环 关节 上 与 前 续 构 件 p(k) 和 后 继 构件 
s(k) 相连 ,集合 LR(i) 为 构件 i 的 环 编 号 ， 这 里 
构件 i 为 根 环 。 在 生成 树 中 对 构件 运用 p(i) «i fe 
性 ， 根 环 选 为 具有 最 小 编号 的 构件 ， 同 时 构件 i 的 
集合 LB(i) 给 出 了 环 的 编号 ,构件 i 属于 环 但 不 
是 根 。 

图 2.3 给 出 了 闭环 系统 的 一 个 例子 ， 该 系统 由 带 
有 拓扑 变 接点 的 人 形 机 器 人 机 构 组 成 ， 分 别 与 外 界 及 
内 部 机 构 相 连 ， 形 成 闭环 。 系 统 有 N, = 16 个 运动 构 
fF GEI) 和 Ni = 19 个 关节 ， 以 及 N 2 N,- N, 53 
个 环 。 主 构件 (1) 作为 移动 机 器 人 系统 的 浮 基 ， 其 
与 固定 基 (0) 通过 一 个 假定 的 六 自由 度 关节 1) 
相连 。 为 完成 本 例 ， 对 一 个 环 的 闭环 关节 、 构 件数 
p(k) 和 s(k)， 以 及 根 构件 等 都 通过 表 2.2 给 出 ， 基 
于 构件 的 集合 c(i) 和 ZLR(i) 在 表 2.3 中 给 出 。 注 意 
本 例 中 LR(0) 2 11, 3}, LR(1) = {2}, HASH) LR 
BASE. 


2.4.2 连 杆 几何 


当 两 个 构件 ( 连 杆 ) 通过 关节 连接 ， 该 连接 的 
完整 性 描述 由 关节 本 身 以 及 两 个 坐标 系 的 定位 来 表 
述 ， 每 个 构件 上 有 一 个 坐标 系 ， 指 出 关节 定位 在 构件 
的 什么 地 方 。 如 果 系 统 中 及 ,个 关节 ， 则 总 共有 2WN, 
个 附属 的 关节 坐标 系 。 其 中 一 半 的 坐标 系 采 用 1 ~N, 
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图 2.3 仿 人 机 器 人 实例 
注 : 图 中 为 了 区 分 构件 编号 和 关节 编号 ， 在 构件 
编号 前 面 加 上 字母 “B" 


R22 人 形 机 器 人 算 例 中 的 闭环 关节 及 根 环 


环 1 | 闭环 关节 大 p(k) s(k) 根 
1 17 0 5 0 
2 18 16 1 1 
3 19 0 13 0 


R23 人 形 机 器 人 算 例 中 的 构件 集 


构件 i | c(i) | LB(i) | 构件 i c(i) LB(i) 
0 1 

1 2,9 | 1,3 9 10, 11, 14 | 2, 3 
2 3,6 1 10 

3 4 1 11 12 3 
4 5 1 12 13 3 
5 1 13 3 
6 7 14 15 2 
7 8 15 16 2 
8 16 2 


进行 编号 ， 其 余 的 标示 为 几 JN, EART m^ 
标 系 Ji BMA i 进行 连 接 ， 对 于 关节 1 ~ Ne ( 即 树 
关节 )， 坐 标 系 i 刚性 放置 于 构件 i 上。 对 于 关节 
Ns+1 到 NN,， 用 于 闭环 关节 名 的 坐标 系 k， 将 刚性 放 
置 于 构件 s(k) 上 。 对 每 个 关节 i;， 无 论 是 树 关节 还 
是 闭环 关节 ， 第 二 个 坐标 系 Ji WEEE pCi) 
E, BERA Ji HRI 抑 提 供 基 坐 标 ， 相 对 于 此 坐标 
系 定义 关节 的 平 动 和 转动 。 

图 2.4 显示 的 是 系统 中 的 坐标 系 ， 以 及 与 每 个 关 
有 关 的 坐标 变换 。 对 于 树 关 节 ， 从 坐标 系 p(i) 到 
标 系 i 的 坐标 变换 给 定 如 下 : 

Kaye Xp hag XXX) (2,60 
stp, ZME X (i) 为 固定 的 连 杆 变换 ， 它 设 定 
AX i WEA 五， 相对 于 pCi) 的 变换 ， 可 用 于 
将 空间 运动 矢量 从 p(i) 变换 到 天 坐标 ; XG) 为 一 
可 变 的 关节 变换 矩阵 ， 其 用 于 完成 关节 i 从 坐标 .到 
i 的 坐标 变换 。 


= at 


Xi) 


a) b) 


图 2.4 坐标 构 型 和 变换 
a) 树 关 节 b) 闭环 关节 


类 似 的 ， 对 于 闭环 关节 ， 从 坐标 系 p(k) 到 坐标 

系 上 的 坐标 变换 如 下 : 
= X, =X,(k Xk) (2.62) 
附加 变换 X, (k) 定义 为 从 坐标 系 s(k) 到 坐标 

系 上 的 坐标 变换 ， 其 表示 如 下 : 
Xj (Kk) =*X un (2.63) 
连 杆 和 关节 数据 可 以 通过 多 种 途径 来 指定 ， 最 和 常 
用 的 方法 是 使 用 D-H ( Denavit- Hartenberg) 参 
BOS) 。 然 而 标准 的 D-H 参数 不 完全 具有 通用 性 ， 
不 足以 对 几何 特性 进行 完整 描述 ， 如 有 分 支 的 运动 
树 ， 或 者 包含 有 某 些 多 自由 度 关节 类 型 的 机 构 。 本 书 
中 采用 了 修正 形式 的 D-H BR?! ， 用 于 单 自由 度 关 
节 ( 见 1.4 节 )。 这 些 参数 已 扩展 到 有 分 支 的 运动 树 

及 闭环 机 构 上 。 


2.4.3 连 杆 惯量 
连 杆 惯量 数据 包括 机 构 中 各 连 杆 的 质量 、 质 心 位 
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置 和 转 到 惯量 。 在 坐标 系 i 中， 连 杆 i 的 惯性 参数 表 
达 式 为 常数 。 


2. 4.4 关节 模型 


两 个 连 杆 之 间 的 连接 关系 ， 常 采用 Roberson- 
Schwerassek (R-S) 广义 关节 模型 描述 > 。 对 于 运动 
树 或 者 闭环 机 构 上 的 生成 树 ，n; xl 的 矢量 q; RRE i 
相对 于 其 父 构件 p(i) 的 速度 ， 其 中 n, 为 连接 两 个 连 杆 
的 关节 的 自由 度数 。 对 于 闭环 机 构 的 闭环 关节 ， 为 连 杆 
s(i) 〈 后 继 杆 ) 和 连 杆 p(i) (前 导 杆 ) 之 间 的 速度 关 
系 ， 在 其 他 情况 下 为 坐标 系 ;和 抑 间 的 速度 关系 。 

S Vu 和 a 为 穿 过 关节 i 的 速度 和 加 速度 ， 即 
s(i) 相对 于 p(i) 的 速度 和 加 速度 。 关 节 的 自由 模式 
用 6 xz 的 矩阵 D RIR, EXPE v RI a 表示 如 下 : 

(2. 64) 


va 70,4, 
(2.65) 
RP, o BORE X 32877, EE ,为 列 满 
秩 ， 故 可 定义 一 个 互补 矩阵 BS, LE 6x6 BY 
(BB!) Ju pu RE, 我们 可 将 这 个 矩阵 的 列 看 成 
M" 上 的 基 ， 以 便 将 第 一 个 n, 基 矢量 (和 矩阵 第 一 列 ) 
定义 为 运动 的 允许 方向 ， 且 其 余 的 6 -n =n 个 矢量 
定义 为 运动 的 不 允许 方向 。 这 样 ， 更 :表示 关 节 ; 的 约 
束 模 式 。 

通过 关节 i， 从 前 导 杆 向 后 继 杆 传 递 的 力 f,， 给 


WP: 
T; 
Z7 


RP, T 为 沿 自由 模式 的 n; x 1 作用 力 矢 量 ; AU 
(6 —-n,) x1 的 约束 力 矢量 ; e FL EGRE FIERE; 
Qa) = (0,7) * (2. 67) 
对 于 大 多 数 常见 的 关节 类 型 ， 可 通过 选择 D, M 
dx, MEERE (DP) 数值 上 正 交 ， 从 而 使 (uu) 
AXE EA (0,57) 相等 。 注 意 式 (2.67) 含有 如 
下 关系 : (P) D: lw (WTD: 20, 
COLE npn (WW = Vieng visa 0 当 将 
其 应 用 于 式 (2.66) 时 ， 可 得 如 下 结果 : 
T; = df, 


au =@.4,+0.q, 


(2. 66) 


(2. 68) 
st (2.65) PE WERTET, LE 

公式 为 
b, =P, +v, x 5, (2.69) 


RP, v Æ EIF i EHE. 更 ,是 更 的 表 观 导数 ， 即 


观察 者 随 连 杆 ; 一 起 运动 时 所 看 到 的 ， 丰 ,给 定 如 下 ; 


(2.70) 


WAKE Lee. .-0, 

采用 D-H 约定 时 ， 对 单 自由 度 关节 (n; 21) 就 特 
别 简 单 ， 运 动 选择 为 沿 & 轴 横向 平移 或 绕 &, 轴 轴 向 旋转 。 
在 这 种 情况 下 ， 对 于 平移 关节 更 = (00000 1)", XE 
转 关节 $= (001000)', 同样 @, -0. 

对 于 移动 机 器 人 浮 基 的 虚拟 六 自由 度 关节 来 说 ， 
也 很 容易 作 相 关 的 处 理 ， 这 种 情形 下 更 =1 (6x6 
的 单位 矩阵 ), 且 $, =0。 

旋转 关节 和 浮 基 关节 ， 以 及 万 向 关节 (n =2) 
和 球 关节 (n; =3)， 在 下 一 节 中 将 进行 举例 说 明 。 更 
多 关节 运动 学 的 问题 ， 详 见 1. 3 节 。 


系统 算 例 


为 说 明 连 杆 及 关节 模型 的 规则 约定 ， 人 形 机 器 人 
的 坐标 系 分 别 放 在 前 五 根 连 杆 〈 构 件 ) 和 固定 基 上 ， 
如 图 2. 5 所 示 。 注 意 对 5 个 关节 ， 每 个 关节 的 坐标 系 
Ji WEI p(i) =i-1 b, ASB Ji 的 坐标 原点 放 
在 与 坐标 系 0 的 原点 重合 位 置 ， 且 坐标 系 2, BY 
JA, J5 的 坐标 原点 分 别 与 坐标 系 2、3、4、5 的 原点 
重合 。 注 意 几 可 以 设置 为 固定 基 (BO) 上 的 任意 位 
置 /姿态 ， 以 方便 表示 浮 基 (BI) 相对 于 固定 基 的 运 
动 ， 同 样 J2 的 原点 也 可 以 设 在 沿 2 的 任意 位 置 。 

表 2.4 中 给 出 了 本 例 中 每 个 关节 的 自由 度数 、 基 
坐标 系 Ji B DEL x Je PERLE Je PE Pe" Ros 将 
pli) 坐标 系 中 的 3 维 矢量 变换 到 坐标 系 中 。 位 置 
矩阵 "有 为 原点 0; 相 对 于 Opo 的 位 置 , 用 p(i) AB 
标 系 表示 的 矢量 。 空 间 变 换 矩 阵 X, (i) -" X, 可 通 
过 表 2. 1 中 的 3 维 量 对 *X, 变换 构成 。 人 形 机 构 具 有 
浮 基 、 躯 干 、 躯 干 和 骨盆 间 的 旋转 关节 (关于 2 )、 
通 部 的 球 关 节 、 膝 部 的 旋转 关节 ， 以 及 脚 踩 处 的 万 向 
关节 。 如 图 2.5 所 示 ， 腿 部 微 弯 ， 脚 向 外 面 倾 斜 CH 
部 名 方向 有 大 约 90° 的 旋转 ) 。 

人 形 机 器 人 中 ， 对 于 所 有 关节 类 型 的 自由 模式 、 
速度 变量 ， 以 及 位 置 变量 均 在 表 1.5 和 表 1.6 中 给 
出 。 通 过 关节 变换 关系 承 (i) ='X,,, A eee dep 
的 R, 和 /pi 分 别 给 出 及 ;和 /p, 的 表达 式 。 旋 转 关节 关于 
2? 轴 的 旋转 遵循 D-H 约定 ， 紧 随 关 于 3 轴 的 滚动 旋 
转角 B; ， 躁 关节 有 关于 ?5 轴 的 俯仰 旋转 角 on, (IUK 
1.1 PAY Z-Y—-X Wehrfüx 9). MOS V BE PR S 
AEREE, Aute GALA ERKAT, TAP 
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图 2.5 人 形 机 器 人 示例 中 前 5 个 构件 和 关节 的 
坐标 系 示意 图 


表 2.4 系统 算 例 中 ， 关 节 自 由 度数 、 


旋转 和 矩阵 和 位 置 矩 阵 
关节 nj "Ryo POR, 
1 6 133 03 3 
0 
2 1 15.5 0 
zh 
10 0 0 
3 3 0 0 -1 -L 
0 1 0 0 
0 
4 1 15.5 2l; 
0 
0 -1 0 0 
5 2 1 0 0 24, 
0 0 1 0 


JUR e, RRRS, WIRK E, 和 相对 转动 率 
w,, 的 关系 在 本 书 的 1.7 节 已 给 出 。 

浮 基 采 用 躯干 "op ,的 位 置 和 四 元 素 <, 分 别 作为 其 
位 置 和 姿态 变量 。 躯 干 的 位 置 可 通过 对 连 杆 的 速度 进 
行 积分 来 计算 ， 在 固定 基 坐 标 中 表示 为 :"y, =Rv, 
其 中 ，w 为 动 坐标 系 中 躯干 的 速度 。 
注意 这 里 除了 万 向 节 外 ， 对 于 其 他 关节 有 更 , =0。 
因为 连 杆 5 坐标 上 外 的 分 量 随 B, 变 化 ， 故 2 关 0。 更 
详尽 的 关节 运动 学 见 本 书 的 1.3 节 。 


2.5 运动 树 


与 闭环 机 构 的 动力 学 相 比 ， 运 动 树 的 动力 学 要 简 
单 并 易于 计算 一 些 。 闭 环 机 构 的 许多 算法 首先 要 计算 
生成 树 的 动力 学 ， 然 后 再 加 上 闭环 约束 。 

本 节 讲 述 运 动 树 的 如 下 动力 学 算法 : win] a 
的 递归 牛顿 - 欧 拉 算 法 (RNEA) 、 正 向 动力 学 的 关节 
体 算 法 (ABA), 、 计 算 关 节 惯 性 矩阵 (JSIM) 的 复合 
刚体 算法 (CRBA) ， 以 及 用 于 计算 操作 空间 惯性 矩 
阵 (OSIM) 的 两 种 算法 。 


2.5.1 递归 牛顿 - 欧 拉 算 法 


这 是 一 种 计算 复杂 度 为 0(n) 的 算法 ， 用 于 
计算 固定 基 运 动 树 的 逆向 动力 学 , 它 是 基于 Luh 
等 人 的 一 种 非常 高 效 的 牛顿 - 欧 拉 算法 
(RNEA) 天 。 另 外 有 关 浮 基 的 算法 可 在 参考 文献 
[2.8, 15] 中 找到 。 给 出 关节 的 位 置 和 速度 变量 ， 
该 算法 计算 应 用 关节 力矩 / 力 变量 时 ,需要 给 定 一 
组 关节 加 速度 。 

首先 ， 连 杆 的 速度 和 加 速度 可 通过 向 外 递归 计算 
出 来 ， 即 从 固定 基 向 树 的 叶 链 ( 连 杆 ) 方向 递归 。 
在 递归 过 程 中 ,采用 牛顿 - 欧 拉 方程 式 〈2.35) ， 计 
算出 每 个 连 杆 上 的 合力 。 其 次 ， 向 内 递归 采用 每 个 连 
杆 上 的 力 平衡 方程 来 计算 经 过 每 个 关节 的 空间 力 ， 以 
及 每 个 关节 力矩 / 力 变 量 的 值 。 影 响 计算 效率 的 关键 
步 又 在 于 如 何 把 最 多 的 量 纳入 到 连 杆 局 部 坐标 中 。 同 
样 ， 机 构 向 上 加 速 时 ， 每 个 连 杆 上 的 重力 影响 也 应 包 


括 在 方程 中 。 

计算 过 程 分 为 如 下 4 步 ， 其 中 两 步 中 ， 每 步 有 两 
次 递归 。 

1) 第 一 步 。 从 固定 基 的 已 知 速度 和 加 速度 开 


台 ， 依 次 计算 每 个 连 杆 的 速度 和 加 速度 ， 并 朝 树 顶 方 
向 进行 ， 即 连接 图 中 的 叶 节 点 方向 。 
运动 树 上 每 个 连 杆 的 速度 由 递归 公式 给 出 
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— ye CET 4) 第 四 步 。 计 算 关 节 力 变量 T;。 由 定义 得 
str, v 为 连 杆 i 的 速度 ,为 关节 i Ie PM, T; - df, (2.75) 


q, 为 关节 ;i 的 关节 速度 变量 的 矢量 。 
加 速度 的 等 效 换算 公式 可 通过 对 式 (2.71) 求 
微分 得 到 


aca, +D, q; «5,4, (a, 20) (2.72) 
SUH, a HERP i OIRE; qi 为 关节 加 速度 变量 的 


矢量 。 
机 构 上 均匀 重力 场 的 影响 ， 可 通过 将 ae 中 的 零 
初始 化 为 - as 来 模拟 实现 ， 这 里 a, 为 重力 加 速度 矢 
在 这 种 情况 下 ，a; 不 是 连 杆 的 真实 加 速度 ， 而 是 
真实 加 速度 与 - a, 的 和 。 
2) 第 二 步 。 计 算 每 个 连 杆 的 运动 方程 。 这 一 步 
计算 力 时 需要 用 到 上 一 步 计算 得 到 的 加 速度 。 连 杆 i 
的 运动 方程 为 


EL 
FH 


Æo 


f° =I,a;, +v; xI;v; (2. 73) 
式 中 , I 为 连 杆 i 的 空间 惯量 ; f NEA Pe i 
的 力 。 
3) 第 三 步 。 计 算 通 过 每 个 关节 的 空间 力 。 参 照 
2.6， 作 用 于 连 杆 i 上 的 力 为 
人 = 人 + Dt 


jeeli) 
式 中 , PIRH iW; ty APE ETT i ET 


图 


有 相关 外 力 之 和 ; c(i) 为 连 杆 i 的 子 集 。 重 新 整理 
方程 ， 得 到 计算 关节 力 系 的 递归 公式 如 下 : 


f-f-f-»f 


jeeli) 


(2.74) 
式 中 , i 从 Ns 到 1 ER, 


c(i) - {c1, C2, sees Cm] 


关节 i 
图 2.6 作用 于 连 杆 i 的 力 系 

人 可 能 包括 这 些 因素 的 贡献 ， 如 弹 筠 、 阻 尼 咒 、 

力 场 、 外 界 接 触 等 ， 但 其 值 应 假设 已 知 ， 或 至 少 可 通 

过 已 知 量 计算 出 来 。 如 果 重 力 还 未 通过 虚拟 基 的 加 速 

度 模 拟 ， 则 作用 于 连 杆 i 的 重力 项 必须 纳入 到 让 中 。 


1. 无 坐标 (Coordinate- Free). 算法 

表 2.5 表示 的 是 式 (2.71) ~ 式 (2.75) 所 包括 
的 算法 ， 它 是 牛顿 - 欧 拉 算法 (RNEA) 的 无 坐标 形 
式 。 这 是 该 算法 的 最 简单 形式 ， 适 合 于 数学 分 析 及 相 
关 用 途 ， 但 不 适合 用 于 数值 计算 ， 因 为 数值 形式 的 算 
法 必须 采用 坐标 矢量 。 
表 2.5 用 于 逆向 动力 学 的 无 坐标 递归 牛顿 - 欧 拉 算 法 


vo =0 
a = —a, 
for i=1 to V, do 
Vi = Va) +0,4; 
a; = aj(i) +@, q; +9,4, 
f-La;*v;xl;v; -fF 
end 
for i = V, to 1 do 


T; - f, 

if p(i) 750 then 
fio =o) +f; 

end 


end 


2. 连 杆 坐 标 算 法 

一 般 情 况 下 ， 如 果 对 每 个 连 杆 定义 一 个 坐标 系 ， 
我 们 所 说 的 算法 就 在 连 杆 坐标 系 中 实现 ， 且 对 于 连 杆 
i 的 计算 ， 就 在 与 连 杆 ;相关 联 的 坐标 系 中 完成 。 替 
代 方 案 是 在 绝对 坐标 系 中 实现 算法 ， 在 这 种 情况 下 ， 
所 有 的 计算 都 在 单一 坐标 系 (通常 为 基 连 杆 ) 中 完 
成 。 在 实际 中 ， 采 用 关节 坐标 来 实现 牛顿 - 欧 拉 算法 
(RNEA) 效率 更 高 ， 这 点 也 适用 于 多 数 其 他 动力 学 
算法 。 

为 将 RNEA 转换 为 连 杆 坐标 ， 首 先 要 检查 方程 中 
哪些 量 来 自 一 个 以 上 的 关节 。 方 程式 (2.73) 和 方 
程式 (2.75) 中 的 每 个 变量 都 只 属于 关节 i， 故 不 用 
修正 。 这 样 的 方程 称 为 关节 的 局 部 方程 。 其 余 方程 
中 的 量 来 自 于 一 个 以 上 的 关节 ， 因 而 需要 插入 坐标 转 


换 和 矩阵 。 这 样 方程 式 (2.71)、 式 (2.72) 及 式 
(2.74) 修正 后 的 形式 为 
MEE Xu Vi) + Bq, (2.76) 
a; -X,5a,5 + ®, 4; * 5,3, (2.77) 
及 
f = fixe + D XT (2.78) 


jec(i) 
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方程 式 (2.78) 假设 外 力 都 作用 在 绝对 坐标 系 如 果 没 有 外 力 ， 此 代码 可 以 省 略 。 如 果 仅 有 一 个 集中 


( 即 连 杆 0) 上 。 
完整 的 算法 见 表 2-6。 函 数 jtype 返回 关节 i 的 类 
型 代码 ; 函数 xjcalc 计算 指定 类 型 关节 的 关节 变换 矩 
阵 ; 函数 pcale 和 pdeale 分 别 计算 p, 和 ®,, ix E PR 
数 应 用 于 各 种 关节 类 型 公式 的 情况 ， 见 表 1.5 和 表 
1.6。 在 一 般 情 况 下 ，pcalc 和 pdcalc 都 是 需要 的 ， 然 
而 ， 对 大 多 数 和 常见 的 关节 类 型 ， 更 在 连 杆 坐标 系 中 


为 已 知 常数 ， 因 


而 外 ,为 零 。 如 果 预 先知 道 所 有 关节 


都 具有 这 一 属性 ， 则 可 简化 相关 算法 。 在 关节 坐标 系 
ELX (i) 均 为 已 知 常数 ， 也 都 是 描述 机 器 人 
机 构 数据 结构 的 一 部 分 。 


表 2.6 空间 矢量 递归 牛顿 - 欧 拉 算 法 


HA 


inputs: q, 4, d, model, ff 


output; T 


model data: Ng, jtype(i), p(i), X (i), I 


vo =0 


ao = 


-a, 


for i-1 to Np do 


end 


X,(i) =xjeale(jtype(i), qi) 
Per =X,(i) X, (i) 
if p(i) 750 then 
'Xo = "Xo zn Xo 
end 


®, = pcalc( jtype(i) , q;) 


® „= pdeale(jtype(i), q;, 


Vi = 


DVD + Pg; 
47 BD, qi+VvxD,g; 
a; ='X apa) +B qi *£; 


= iy-T Ofe 
f; =a; +v; xI,v; -'X; f; 


for i = V, to 1 do 


end 


Ti- o, f, 
if p(i) 750 then 
_ iyT 
f) =f + Xp fi 


end 


qi) 


力 ， 例 如 : 一 个 作用 于 机 械 辟 末端 执行 器 上 的 外 力 ， 
则 此 代码 可 由 另外 的 代码 来 替代 ， 和 替代 代 码 采 用 
蕊 ，， 将 外 力 矢量 依次 从 一 个 连 杆 坐标 系 变换 到 下 


Bs 


; 尽管 “ 连 杆 坐标 ”一 词 表 明 我 们 正在 使 


用 移动 坐标 系 ， 事 实 上 算法 是 在 静止 坐标 系 中 实现 
的 ， 它 刚好 在 当前 时 刻 与 移动 坐标 系 一 致 。 
3. 三 维 矢量 递归 牛顿 - 欧 拉 算 法 (RNEA ) 


RNEA 的 原始 版 本 是 采 


] 3 维 矢量 开发 和 表达 


$97, 362.7 显示 了 该 算法 的 一 个 特例 ， 其 中 关 


i 


在 第 1 次 循环 中 ， 最 后 一 项 任务 是 将 每 个 f, 初 始 


化 为 表达 式 人? XE (采用 恒等式 :XI SX), R 


(2.78) 右边 的 求 和 在 第 2 次 循环 中 完成 。 


此 算法 包 


括 计算 ' 和 ,的 代码 ， 它 用 于 将 外 力 变换 到 连 杆 坐标 上 ; 


节 均 假设 为 旋转 关节 ， 


目 关 节 轴 假设 与 连 杆 坐标 系 的 


z 轴 一 致 ( 没 有 这 些 假 设 , 方程 会 长 很 多 ) ， 另 外 假 


设 外 力 为 零 。 
表 2.7 


三 维 矢量 递归 牛顿 - 欧 拉 算法 


( 仅 对 旋转 关节 ) 


inputs: q, q, q , model 


output, T 


model data ; 


wo =0 
wo -0 
V DES 
yg 2 — XQ 


for i-1 to N, do 


Np, POY, Ru) ”® Pi, mi, ei, 1 


‘Ry 2rotz(q;) R, Ci) 


w; Z'Ry59,5 +Z 


w; = "Ri) Opi) + CR yi) pci ) XZ qi 42; 4; 


E m) 
vi = Ro ( Vi) 


. "m 
+ Oi) x" Dp + 


Oi) x O,(i) x KD pi) 


f, 2 m;(9/ + 0, xc; +0; XO; XC) 


om 


_ Je Jem 
n; - I?" o, +w; XI" 0, * c; x f, 


end 
for i = N; to 1 do 
T, -27n, 
if p( i) #0 then 


= 
Fy 7 fuo + Rin fi 


_ icm (à E" 
nj; Enyi + Ro n+ pi X Ryo f, 


end 


end 


在 本 算法 中 ， 


v/ 是 由 于 重力 引起 的 线 加 速度 ， 


在 基 坐 标 系 ( 连 杆 0) 上 表示 ; rotz 计算 旋转 矩阵， 
该 矩阵 表示 坐标 系 沿 z 的 旋转 ; R CG) 为 X,(i) 的 


qk 
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转动 分 量 ;'R A Xpo 的 转动 分 量 ; peale 和 
pdeale 这 里 没有 用 到 ， 因 为 @,; 为 已 知 常数 (2707)”; 
vi ER i 坐标 原点 (0,) 的 线 加 速度 ， 且 为 关节 i 
经 典 加 速度 的 直线 分 量 ;"p; 为 用 p, 坐 标 系 表示 的 ， 
0; 相 当 于 0 的 位 置 。 另 外 m;, cffll Te" HKT i dS 
惯性 参数 ( 见 表 2.1 中 三 维 量 与 空间 量 关 系 的 相关 
方程 ) 。 

初 看 起 来 三 维 矢量 算法 明显 不 同 于 空间 矢量 算 
法 。 然 而 可 以 直接 通过 空间 矢量 算法 方便 得 到 三 维 矢 
量 。 具 体 实现 方法 为 : 通过 扩展 空间 矢量 为 三 维 矢 
量 ， 将 关节 类 型 限定 为 旋转 关节 ， 并 将 空间 加 速度 转 
换 为 经 典 加 速度 (B, RER (2.22) 将 每 个 ;用 
vl -w xu 替代 ) ， 再 将 某 些 三 维 矢量 恒等式 带 入 表 
2.7 所 示 的 方程 中 。 将 空间 加 速度 变换 为 经 典 加 速 
度 ， 有 一 个 有 趣 的 效应 : vy, 抵偿 了 运动 方程 ， 因 而 不 
需要 计算 。 因 此 ， 三 维 算法 比 空间 算法 具有 微弱 的 速 
度 优 势 。 


2.5.2 关节 体 算法 


关节 体 算法 (The Articulated- Body Algorithm, 
ABA) 是 一 种 计算 复杂 度 为 0(Ns) 的 算法 ， 主 要 用 
于 计算 运动 树 的 正 向 运动 力学 问题 。 而 在 正常 情况 
下 ，O(Ns) =0(n)， 故 我 们 将 其 归 诸 于 O(n) 算法 。 
Featherstone! "1 提出 了 ABA， 并 将 其 作为 约束 传播 算 
法 的 一 个 例子 。 给 定 关 节 位 置 、 速 度 和 作用 力矩 / 力 
变量 ， 这 种 算法 就 可 以 计算 出 关节 加 速度 。 随 着 关节 
加 速度 的 确定 ， 又 可 以 用 数值 积分 进行 机 构 运 动 的 
模拟 。 

ABA 的 重要 概念 如 图 2.7 所 示 。 在 连 杆 i 处 ， 
根子 树 与 运动 树 i 上 其 他 部 分 的 作用 仅 通 过 经 由 关 
节 二 的 力 f 来 实现 。 假 设 我 们 在 这 点 将 树 切断 ， 只 
考虑 受到 作用 于 连 杆 上 的 未 知 力 f; 时 子 树 的 运动 情 
况 。 可 以 发 现 ， 连 杆 i 的 加 速度 与 作用 力 有 如 下 
关系 


mi 


f,-Ija +p; (2.79) 
RP, TP (RERIK EER) 中 连 杆 i 
MS Mie; pi 为 辅助 偏 置 力 (bias force) ， 即 让 
连 杆 i 出现 零 加 速度 的 力 。 注 意 在 关节 体 中 ，p/ 与 单 
个 构件 的 速度 有 关 。 方 程式 (2.79) 考虑 了 子 树 的 
力学 问题 ， 这样 只 要 知道 了 ff, 的 值 ， 式 
就 会 立刻 给 出 连 杆 i 的 加 速度 。 

门 对 天 和 pp! 两 个 量 感 兴趣 的 原因 在 于 ， 可 以 
门 从 a; 计算 得 到 9 ， 依 次 可 以 计算 出 a,， 


N 
连 杆 p(i) | SR 


在 关节 之 处 断 开 连 杆 ;处 的 根子 树 = 关节 体 i 


图 2.7 关节 体 i 的 定义 


从 而 计算 出 更 多 关节 的 加 速度 。 结 合式 (2.72), X 
(2.75) 和 式 (2.79) 得 到 


Ti -9/f, =@! (I! (a, t$, q: +@q,) +p’) 
对 4 可 由 下 式 求解 


gq; -D,(u; -Uj ap ) (2. 80) 
其 中 
U, - I; 6, 
D, =(®'U,)  -(oiro)'" 
u, =T; -Ui$, - D; pi 
H 


É, =ð, = Dg, +y, x $.q, 
这 样 就 可 通过 式 (2.72) 计算 ai。 


关节 体 惯 量 和 偏 置 力 都 可 通过 递归 公式 计算 
L-L«Y GG -UDU) (281) 
jec(i) 
和 
pi =p; + > (pi + +UDu,) (2.82) 
jec(i) 
其 中 


p; =V; XI v, -ff 

通过 检验 图 2.7 P EM a MCR, ER DU 
pc jecG) 为 已 知 的 情况 下 ， 就 可 以 得 到 这 些 
公式 。 更 详细 的 情况 见 参考 文献 [2.1, 8, 15, 24], 

完整 的 算法 见 表 2.8。 表 中 采用 连 杆 坐标 表示 ， 
并 按照 表 2.6 的 牛顿 - 欧 拉 算 法 (RNEA ) ， 通 过 运动 
树 共 进行 3 遍 迭 代 计 算 。 第 一 遍 从 基 座 〈 底 部 ) 向 
末端 (顶部 ) 迭代 ,分 别 运 用 式 (2.76) 计算 连 杆 
速度 和 速度 积 项 C, = @,g,， 并 将 变量 和 p? WI 8 46 
JAE ERI p;(p; 2 v; x Lv; - Xo £7) ; 第 二 遍 从 顶部 反 
向 基底 迭代 ， 运 用 式 (2.81) 和 式 (2.82) 计算 关 
节 体 惯量 和 每 个 连 杆 的 偏 置 力 ; 第 三 遍 从 基底 向 顶部 
迭代 ,运用 式 (2.80) 和 式 (2.77) 计算 连 杆 和 关 
节 的 加 速度 。 
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表 2.8 正 向 运动 学 的 关节 体 算法 

inputs; q, q, T, model,? fe 
output: q 
model data: Ng, jtype(i), p(i), X i), I 
vo =0 
ao = 一 3ag 
for i=1 to Nz do 

X; (i) 2xjeale(jtype(i) , q;) 

X, oj =X 0X0) 

if p( i) 40 then 

‘Xo = "Xon PO Ko 

end 

9, = pcalc( jtype( i), q;) 

®,, = pdcalc(jtype(i), q;, gi) 

Vi= KV) + 9,4; 

6-70, d+tv, x bd, 

n =I; 


A iy-T Ope 
p; =V; XI;vj -'Xg f; 


end 

for i = V, to 1 do 
U - 110, 
D, = (®/U;) ~ 


u; =T; - Ure, = Dp} 
if p( i) #0 then 
Do =o + Xi -U;DU; ) X5 
Pio = ph;) £X (pi HM, *UjDyu;) 
end 
end 
for i=1 to Nz do 
a; = "X, ap) 
3; -D,(u; -Uja;) 
a; za; + Ó, q; +; 


end 


2.5.3 复合 刚体 算法 


复合 刚体 算法 (CRBA) 是 用 于 计算 运动 树 的 关 
节 空 间 惯性 矩阵 (JSM) 的 一 种 方法 。CRBA 最 常见 
的 应 用 是 作为 正 向 动力 学 算法 的 一 部 分 ， 该 方法 最 先 
出 现在 参考 文献 [2.5] 的 方法 3 中 。 
在 关节 空间 中 ， 正 向 运动 学 的 任务 是 通过 q、q 


和 T 计 算 q 。 最 常见 的 进行 方式 是 ， 从 式 (2.37) 
开始 ， 先 计算 五 和 Cq tT, 然后 对 q 求解 线性 
方程 


Hq =T-(Cq +T) (2.83) 

如 果 机 构 为 运动 树 ， 则 五 和 Cgq + 的 计算 复 困 
BEA O(n?) 和 0(n), HA (2.83) 可 在 
O(n?) 操作 下 求解 ， 因 而 把 采用 这 种 方法 的 算法 统 
PRA O(n) 算法 。 然 而 O(n’) 形式 应 考虑 最 坏 的 计 
算 复 杂 度 ， 因 为 实际 复杂 度 取 决 于 树 中 的 分 支 数 。 此 
外 ， 即 使 在 最 坏 情况 下 ， 由 于 站 项 具有 小 系数 ， 直 
#14 n260 时 这 项 才 会 起 主导 作用 。 

Cdq+ 严 可 通过 逆向 动力 学 算法 计算 ， 如 果 
ID(q, q, q) 是 由 自 变 量 q、q 和 q 通过 逆向 动 
力学 计算 的 结果 ， 则 

ID(q,q, q) -T-Hq +Cq+t 


故 有 
Cq +T: - ID(q, q, 0) (2. 84) 

这 样 对 于 运动 树 而 言 ，Cq + 到 的 值 可 用 q =0 
时 的 RNEA 进行 计算 。 

复合 刚体 算法 (CRBA) 的 一 个 重要 概念 就 是 要 
注意 JSIM 只 取决 于 关节 的 位 置 ， 而 不 是 速度 ， 
CRBA 所 作 的 简化 假设 是 让 每 个 关节 的 速度 为 零 。 如 
果 也 假设 重力 为 零 ， 则 可 从 式 (2.83) 中 消除 Cq + 
T:。 此 外 对 于 旋转 关节 ， 在 第 j 个 关节 上 作用 一 个 单 
位 加 速度 ， 就 产生 JSM 中 的 第 7 列 ， 这 样 将 机 构 划 
分 成 两 个 复合 刚体 ， 彼 此 通过 第 j 个 关节 相连 ， 此 方 
法 就 大 大 简化 了 动力 学 问题 。 这 已 使 CRBA 推广 应 用 
到 运动 树 结 构 的 任意 关节 类 型 。 

可 以 证 明 对 于 运动 树 ，JSIM 的 一 般 形 式 为 
oro 如 果 iec”()) 
H;= GTGB UWjec'(i) 
0 其 他 
式 中 , c(i) 是 连 杆 i 处 的 根子 树 上 所 有 连 杆 集 ( 包 
括 i 本 身 )， 


(2. 85) 


r= DL 

jec*(i) 
见 参考 文献 [2.8, 15]. EXE, LARAMIE 
量 。 复 合 刚体 由 C) 上 的 所 有 连 杆 刚性 装配 而 成 ， 
该 算法 由 此 而 得 名 。 

式 (2.85) 和 式 (2.86) 为 表 2.9 所 示 算 法 的 基 
础 ， 它 是 在 连 杆 坐标 系 下 的 复合 刚体 算法 (CRBA), 
该 算法 假定 矩阵 和 ,已 经 计算 出 来 (如 在 计算 


(2. 86) 
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Cdq +Ts 时 已 计算 )， 如 果 不 是 这 种 情况 ， 则 可 从 表 i - 
2. 6 中 相应 行 中 插入 第 一 个 循环 ; SEE FOR — 0.90. 
变量 ; 如 果 在 树 上 没有 分 文 , H=0, 第 一 步 可 以 > 0.000 
省 略 。 00.00 
"mE 0 0 0 
X 2.9 复合 刚体 算法 计算 JSIM JSIM . oO . 0 0 0 
inputs; model, RNEA partial results 图 2.8 分 支 引起 的 稀疏 性 : 运动 树 上 的 分 支 臻 
output: H 使 JSIM 的 某 些 元 素 为 0 


model data; Ng, p(i), I; 
RNEA data; ;,'X,5 
H=0 
for i=1 to Ny do 
If =1, 
end 
for i = N; to 1 do 
F «If d, 
H; ="F 
if p(i) #0 then 
Tio =I tX IP XO 
end 
ji 
while p(j) #0 do 
F'xi P 
jzpG) 
H,-F'o, 
H; =H; 
end 


end 


计算 出 Cd +t. Al Ha, Bae Ese (2. 83) 
中 对 q 求解 ， 可 采用 标准 的 Cholesky 分 解 或 LDL" 
分 解 来 完成 。 注 意 互 可 能 具有 高 病态 性 ”2 ， 这 反 
映 了 运动 树 本 身 潜在 具有 病态 性 ， 故 推荐 在 正 向 动力 
学 计算 中 ， 每 一 步 都 采用 双 精 度 算 法 (本 建议 也 适 
用 于 ABA), 

sk (2.85) 表示 如 果 运 动 树 上 有 分 支 ， 则 五 的 
一 些 元 素 自动 为 零 。 图 2. 8 为 这 种 影响 的 例子 ， 可 以 
看 出 近 半 数 的 元 素 为 零 ， 因 而 有 可 能 利用 稀 玻 性 进行 
分 解 ， 其 算法 描述 见 参考 文献 【2. 25] 。 根 据 树 的 分 
支 量 大 小 ， 稀 玻 算法 有 时 会 比 标准 算法 快 许多 倍 。 


2.5.4 操作 空间 惯性 矩阵 


HEZ EEE (OSIM) 可 用 两 种 算法 计算 。 第 
一 种 是 O(n?) 算法 ， 它 采用 OSIM 的 基本 定义 ， 随 


同 JSIM 一 起 进行 有 效 的 分 解 ， 第 二 种 是 0(n) SE, 
它 是 基于 正 向 动力 学 问题 的 有 效 解 。 

1. 采用 基本 定义 的 算法 

如 果 机 器 人 具有 较 少 相关 自由 度 (如 6 个)， 则 
计算 OSIM 最 有 效 的 方法 是 通过 式 (2.52) 进行 ,其 
过 程 如 下 : 

1) 通过 CRBA 计算 五 。 

2) YE H AS H -LL' (Cholesky 分 解 ) 。 

3) EHEHE YS LJ, 

4) A^" zY'Y, 

5) Ay A^ (np), 

最 后 一 步 唯 一 可 能 是 ， 末 端 执 行 器 具有 完整 的 6 
个 自由 度 ， 且 需要 用 到 4 而 不 是 4 。 第 二 步 中 ， 
对 于 有 分 支 的 运动 树 ， 可 用 LDL' 分 解 代替 LL' 分 解 ， 
或 者 采用 参考 文献 [2.25] 中 描述 的 分 解 方法 。 

IÈ (2.38) 中 的 其 他 项 可 由 式 (2.53) 和 式 
(2.54) 计算 得 到 。 特 别 地 ， 式 (2.38) 可 写成 如 下 
形式 

v +4 (x)[n(x,v) *p(x)] A^" GOf 


(2.87) 
ME, A (wu +p) 可 通过 下 述 公式 计算 
A^" (u +p) -JH '(Cq +T,) -Jq (2. 88) 


HH, Ja 项 是 式 (2.50) 中 末端 执行 器 的 速度 积 形 
式 的 加 速度 ， 它 可 由 RNEA 的 式 (2.84) 计算 Cà + 
Ts 时 顺便 得 到 。 特 别 地 ，J q =a.. -a。， 这 里 a 是 计 
算得 到 的 末端 执行 器 的 加 速度 (在 同一 个 坐标 系 时 


JH v 表示 ) ，a 是 基 加 速度 -a,。 

2. O(n) 算法 

当 n 值 足够 大 时 ,采用 0(n) 算法 更 为 有 效 ， 这 
种 算法 更 多 详情 见 参 考 文献 [2. 27-29 ] 。 本 节 给 出 
了 更 简单 的 算法 ， 它 是 基于 关节 空间 正 向 动力 学 问题 
的 0(n) 算法 (例如 通过 ABA)。 它 是 单位 力 方 
法 下 的 一 种 变 体 ， 用 于 计算 OSIM 的 逆 。 

从 式 (2.87) 中 开始 ， 观 察 到 A DUET EIS PRI 
数 ， 动 力学 方程 中 的 一 些 项 可 以 忽略 而 不 影响 其 值 。 
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特别 是 当 关 节 速 度 q、 关 节 力 T 以 及 重力 均 设 为 零 
I, A 的 值 将 保持 不 变 ， 在 这 种 条 件 下 : 
v-A^Cf (2. 89) 
我 们 定义 一 个 六 维 坐 标 矢量 &， 令 其 值 在 第 i 
个 坐标 时 为 1， 其 余地 方 都 为 零 。 如 果 在 式 (2.89) 
中 令 f=&é,， 则 vy 将 等 于 A 的 第 i 列 。 我 们 同样 定 
XK FD, j, q, q, ay, T, f) ， 它 执行 正 向 动 
力学 计算 ,并 返回 连 杆 i 的 真实 加 速度 (a, - ay), 
它 在 同一 个 坐标 系 时 表示 为 f (通常 是 基 坐 标 ) É 
变量 q、q 和 TT 分 别 设 为 关节 位 置 、 速 度 和 力 变 量 
的 值 。 这 里 7 和 f 指 施加 于 连 杆 j 的 外 力 f。 自 变量 
al 为 包含 重力 影响 的 虚拟 基 的 加 速度 ， 其 值 设 为 0 
或 -a,。 
通过 上 述 定 义 ， 得 到 
(A^)! 2 FD(ee, ee, q, 0, 0, 0, è) (2.90) 


及 
A^'(u *p) = - FD(ee, ee, q, q, -a,, T, 0), 
(2.91) 
SUP, (AT) JE A7 ASB BI, ee 为 末端 执行 器 的 构 
件数 。 因 此 式 (2.87) 的 系数 可 以 采用 表 2. 10 的 算 
法 计算 出 来 ， 此 算法 复杂 度 为 0(n)。 


表 2.10 ”用 于 计算 操作 空间 惯性 矩阵 的 逆 


及 其 他 项 的 算法 
forj-1 to 6 do 
vi 2 FD(ee, ee, q, 0, 0, 0, &) 
end 
Analg! hes] 


A^!(u *p) = - FD(ee, ee, q, q, -a,, T, 0) 


g? 


注意 当 计 算 4-' 有 如 下 情形 时 ， 计 算 效 率 会 显著 
提高 : ABA 算法 中 v,、Z, 和 TT; 可 设 为 零 (ILR 2.8), 
A see (与 U, 和 D, 相 关 ) 只 需 计 算 一 次 ， 因 
为 它们 不 随 作 用 力 而 改变 。 此 外 ， 该 方法 可 用 于 多 个 
末端 执行 器 ， 它 通过 调节 FD 来 接受 末端 执行 器 构件 
数列 表 ， 放 和 第 1 个 自 变 量 中 ， 并 返回 一 个 包含 所 有 
间 定 构件 加 速度 的 复合 矢量 。 表 2. 10 中 的 算法 附 上 
一 个 for 循环 来 控制 FD 的 第 2 个 自 变 量 ， 并 遍及 所 
AAR Sa RUT A PGE TIRE?) 。 然 而 对 于 只 有 几 
个 未 端 执行 器 的 情况 ，Lilly2 323] 的 力 传播 方法 应 更 适 
于 提高 计算 效率 。 如 果 有 m 个 末端 执行 器 ， 则 复杂 
度 为 0(mn)。 


2.6 运动 环 


上 节 中 所 有 算法 都 是 用 于 运动 树 的 ， 本 节 将 最 后 
提供 一 种 算法 ， 用 于 闭环 系统 的 正 向 动力 学 问题 。 该 
算法 对 于 闭环 系统 的 生成 树 问 题 补 充 了 运动 体 的 动力 
学 方程 ， 以 及 闭环 约束 方程 ， 给 出 了 三 种 不 同 的 方法 
来 求解 由 此 产生 的 线性 方程 组 ， 并 给 出 了 一 种 用 于 计 
算 闭 环 约束 的 有 效 算法 。 

与 运动 树 相 比 ， 带 有 封闭 运动 环 的 系统 ， 具 有 更 
复杂 的 动力 学 特性 ， 例 如 : 

1) 运动 树 的 运动 自由 度 是 固定 的 ， 而 闭环 系统 
的 运动 自由 度 可 以 变化 。 

2) 运动 树 中 ， 瞬 时 运动 自由 度 总 是 与 有 限 运动 
自由 度 相 同 ， 但 它们 在 闭环 系统 中 可 以 不 同 。 

3) 运动 树 中 每 个 力 均 可 确定 ， 而 闭环 系统 中 的 
某 些 力 可 为 不 确定 。 只 要 闭环 系统 是 过 约束 的 ， 这 种 
情况 就 会 出 现 。 

图 2. 9 为 这 种 现象 的 两 个 例子 。 在 图 2. 9a 的 机 
构 中 ,没有 有 限 运 动 自由 度 , 但 有 两 个 无 限 小 运动 自 
由 度 。 图 2.9b 所 示 的 机 构 ， 当 0240 时 有 一 个 自由 
度 ， 而 如 果 6=0， 则 两 个 辟 4 和 B 能 独立 运动 ， 机 
构 有 两 个 自由 度 。 此 外 ， 在 这 两 个 运动 的 状态 边界 
上 ， 机 构 具 有 3 个 无 限 小 运动 自由 度 。 这 两 种 机 构 都 
是 平面 的 ， 均 为 过 约束 情况 ， 因 此 关节 约束 力 的 面 外 
分 量 是 不 确定 的 。 这 类 不 确定 性 对 机 构 运 动 无 影响 ， 


但 它 使 动力 学 计算 变 得 复杂 。 


ip 
p 


a) b) 


图 2.9 病态 闭环 系统 


2.6.1 闭环 算法 公式 
一 个 闭环 系统 可 以 模拟 为 受到 一 组 闭环 约束 力 的 
生成 树 ， 如 果 


Hq +Cq+t%=T 
9 里 的 运动 方程 ， 则 闭环 系统 的 运动 方程 为 


是 生成 树 
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Hq-«Cq-«T,-T«T «T 
式 中 , 和 TT 分别 为 用 生成 树 广 义 力 坐 标 表示 的 闭环 
主动 力 和 约束 力 和 失 量 。T* 为 已 知 量 ， 而 TT 未 知 ,，T* 来 
自作 用 于 闭环 关节 的 力 元 件 (FASE, BEE ae ASK oh 
器 ) ， 如 果 没 有 这 类 元 件 ， 则 T* =0。 


(2.92) 


闭环 约束 限制 了 生成 树 的 运动 ， 在 加 速度 级 别 ， 
这 些 约束 可 以 表示 为 线性 方程 的 形式 
Ld =1 (2.93) 


式 中 , LH n xn BE; n BAP AA AR 
数 ， 用 公式 给 定 如 下 : 
Ny 


n= ny (2.94) 


式 中 ,ni 为 关节 施加 的 约束 数 。 如 果 rank(L) «n', 
则 闭环 约束 线性 相关 ， 且 闭环 机 构 为 过 约束 。 闭 环 系 
统 的 机 动 性 ， 即 它 的 自由 度 ， 由 以 下 公式 给 出 
mobility =n — rank( L) (2.95) 
给 出 了 式 (2.93) 形式 的 约束 方程 ， 接 下 来 约 
束 力 可 表示 为 


T -LA (2.96) 
式 中 ， A= (Angi An) 为 nm x 1 的 未 知 约束 变量 的 
矢量 〈 或 称 拉 格 朗 日 乘 子 ) 。 如 果 机 构 为 过 约束 ， 则 
L' HAZ lal, FLA 位 于 此 零 空间 的 分 量 将 不 确定 。 
通常 可 以 预先 确定 宛 余 约束 。 例 如 ， 如 果 运 动 环 
已 知 为 平面 ， 则 面 外 的 闭环 约束 是 多 余 的 。 在 这 种 情 
况 下 ， 有 利于 消除 相关 工 的 行 ， 以 及 I 和 和 A 的 元 素 ， 
A 的 移 除 元 素 可 赋值 为 零 。 
对 于 闭环 系统 ， 由 式 (2.92), X (2.93) 及 式 
(2.96) 可 得 如 下 运动 方程 
Je 


D 4) q \_[T+T - (Cq +t) 
L oA) 1 


系统 矩阵 对 称 ， 但 为 不 定 。 如 果 工 为 满 秩 ， 则 
系统 矩阵 为 非 奇 异 和 矩阵 ; 否则 将 是 奇异 的 ， 且 A 的 
一 个 或 多 个 元 素 将 不 确定 。 

方程 式 (2.97) 可 通过 下 列 任 一 种 方法 求解 : 


1) 直接 对 q AA RAR, 
2) 先 解 入， 再 用 其 结果 求解 q 。 
3) 由 式 (2.93) 求解 G, 把 结果 带 入 式 


(2.92) ， 消 去 未 知 约束 力 ， 再 求解 剩余 的 未 知 量 。 
方法 1) 是 最 简单 的 ， 但 通常 效率 最 低 ， 此 方法 适 
用 于 当 系 统 和 矩阵 为 非 奇 异 的 情况 。 当 系统 抢 阵 为 (n 
n)x(nn) 时 ， 此 方法 复杂 度 为 0((n+tn) )。 
方法 2) 对 于 n>>n' 的 情况 特别 有 用 ， 并 可 在 生 
成 树 上 采用 O(n) WOS, H (2.97) 得 


LH 'L'A-1-LH '[T-« - (CQ +T:) ] 
(2.98) 
通过 O(n) 算法 , 方程 可 在 O(n(m )) 操作 中 
用 公式 表示 , 在 O((n')*) 求解 。 一 旦 A 已 知 , TT 可 
HX (2.96) Æ O(n n) 操作 中 计算 ， 且 通过 
O(n) 算法 在 式 (2.96) 中 求解 ， 故 总 的 复杂 度 为 
O(n(n)! -(n)?), WÈL REK, M LH LEA 
异 的 ， 但 仍 为 半 正 定 矩 阵 。 与 式 (2.97) 中 的 不 定 
系统 矩阵 的 奇异 情况 相 比 ， 提 出 的 分 解 方法 稍微 容 
易 些 。 
方法 3) 适用 于 当 -产值 很 小 ， 或 者 当世 预期 
为 从 秩 的 情况 。 式 (2.93) 通过 高 斯 消 元 法 的 专用 
版 (或 类 似 的 程序 ) 求解 ， 它 配备 了 数值 秩 检 验 程 
序 ， 其 目的 是 求解 欠 确 定 系 统 。 其 解 是 一 个 方程 的 
形式 


q=Ky+ qo 

SP, q ,为 式 (2.93) 的 任 一 特 解 ; K 为 nx (n- 
rank(L)) 和 矩阵， 并 有 LK =0; y HELA n - rank(L) 
个 未 知 数 的 矢量 (通常 , 与 q 元 素 的 子 集 线性 无 
关 )。 将 q 的 表达 式 带 入 式 (2.92), ， 并 两 边 左 乘 
K 消去 天 ， 得 到 

KHKy-K'(Tt«Tt'-(Cq*1,) -Hq,) (2.99) 

这 种 方法 也 具有 立方 关系 的 复杂 度 ， 但 如 果 n -n 
很 小 时 ， 此 方法 是 最 有 效 的 。 有 报告 称 此 方法 比方 法 
1) ERE”, 


闭环 算法 


2.6.2 


计算 五 和 Cq +T 算 法 可 分 别 在 2.5.3 RI 
2.5.1 节 中 找到 ， 这 里 只 剩 下 工 、Z 和 7T* 三 个 待 求 值 。 
为 简单 起 见 ， 我 们 假设 所 有 的 闭环 关节 均 为 零 自由 度 
关节 。 为 不 失 一 般 性 ， 假 设 : 将 连 杆 切 开 用 关节 代 
替 ， 简 单 形成 开 环 〈 见 图 2. 10) 。 然 而 这 样 做 可 能 会 
导致 损失 部 分 效率 。 在 这 个 假设 下 ， 我 们 只 需要 计算 
LMI, AAT =0。 


动力 学 等 效 厂 + 五 = 了 


图 2. 10 在 准备 将 环 切 开 的 地 方 插入 一 个 零 自 由 度 关节 
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1. REE 准 技术 应 归功 于 Baumgarte P277?" ， 他 将 每 个 约束 方 
一 般 情况 下 对 于 环 k， 速 度 约束 方程 为 FEH a, =0 形式 替换 为 
(i) O — Vy(4) ) =0 (2. 100) a, + K,v, +K,p, -0 
加 速度 约束 为 式 中 ，a.、v 和 p. 分 别 为 加 速度 误差 、 速 度 误差 和 位 
CHE)" (Qc) = yay) + BD" uy -wo)=0 HRS, AKAK NEAR. Be THe 
(2.101) 数 1.， 它 主要 根据 期 望 多 快 到 该 位 置 和 速度 误差 的 豪 


然而 ， 如 果 每 个 闭环 关节 均 为 零 自 由 度 ， 则 上 述 
方程 简化 为 
(2. 102) 
2,4, (2. 103) 
定义 一 个 环 雅 可 比 (loop Jacobian) ERE J,, € 
具有 以 下 特性 


Vs) — Vp(4) -0 


-a,, =0 


Via) -vb ^ 44d (2.104) 
XB, JI 6 xn WERE, HAREN 
J, = (e, eny Dy,) (2.105) 
其 中 
+1 MEE s(k) ec" (i), H p(k) ec' (i) 
e, =) -1 WS p(k) ec (i), Hs(k) ec' (i) 
0 ”其 他 
KEZ, WRI i 取决 于 路 径 s(k) 而 不 是 


p(k)， 则 ej = +1; WR W i WRF PET p(k) 
Age s(k), We, = -1; mi i 同时 取决 于 两 条 
路 径 或 者 都 不 是 时 ， 则 e, =0。 

环 加 速度 约束 可 记 为 


0 za, 一 an 


=J,q + Ji 

=J, q 十 3500 -a,r 
式 中 ，a?" 是 连 杆 ;的 速度 积 形式 的 加 速度 ， 这 是 
q 为 零 时 连 杆 可 能 具有 的 加 速度 。 每 个 连 杆 的 速度 
积 加 速度 在 式 (2.84) 计算 Cq + 到 时 一 并 计算 。 如 
果 用 RNEA 计算 Cq +T, W az 将 具有 a, 的 值 ， 其 通 
过 RNEA 计算 时 加 速度 变量 设 为 零 。 

AREE L ALT En] ez A Un PIE: 


L 


l 


Ng el Ng el 
L-| : |, f= (2.107) 
Ly, lj. 
其 中 
L, -J, (2. 108) 
I, =a", - ad, (2. 109) 


2. 约束 稳定 性 


在 实际 


FP， 因为 存在 数值 积 


分 误差 ， 必 须 控制 闭 


环 约束 的 稳定 性 ， 否 则 模拟 计算 中 就 会 发 散 。 这 项 标 


减 来 确定 ， 然 后 由 公式 K, 22/1, K, 2 VOR IAE 
K,、K,。 人 然而， 选择 1. 并 没有 一 个 很 好 的 标准 。 如 果 
i. 时 间 太 长 ， 闭 环 误差 的 累积 快 于 衰减 ;如 果 1, 太 短 ， 
则 运动 方程 变 硬 ， 造 成 数值 积分 精度 损失 。 对 于 大 而 
速度 慢 的 工业 机 右 人 ,合理 值 取 为 1, =0.1， 而 对 于 
小 而 快 的 机 器 人 ， 可 以 设 为 1. =0.01。 

将 稳定 性 项 代入 约束 方程 ， 则 式 (2.109) # 
换 为 


(2.110) 
AF, p, NAB, RIRI k MEIRE, TEH X AS 
标 系 下 ( 即 连 杆 0 坐标 系 ) ，pw 给 定 如 下 : 

pa 7x to vec(^ X, 4 Ka (E) X, (k) Xo) 

(2.111) 
AF, Xa (k) AX, (k) 变换 在 式 (2.62) 和 式 
(2.63) "pig Xu, TAT k WES 2.4, x to vec(^ X,) 
用 于 计算 从 坐标 系 A 到 B 的 近似 位 移 ， 假 定 此 位 移 
为 无 限 小 。x_to_vec 定义 如 下 : 


x to vec( X) => (2. 112) 


3. Bik 

作为 一 个 特例 ， 即 当 所 有 闭环 关节 都 具有 零 自 由 
度 时 ， 表 2. 11 给 出 了 用 于 计算 区 和 工 的 算法 。 为 实 
现 对 每 个 量 进行 简单 而 高 效 的 变换 ， 需 要 将 闭环 约束 
公式 放 入 单一 坐标 系 中 。 在 绝对 坐标 系 下 的 情形 时 
( 连 杆 0) ， 则 不 需要 进一步 变换 。 
第 一 个 循环 计算 绝对 坐标 到 连 杆 坐 标的 变换 ， 并 
将 ,变换 到 绝对 坐标 系 下 ， 这 里 更 仅 在 闭环 约束 中 

需要 变换 。 

第 二 个 循环 根据 式 (2.105) 计算 工 的 非 零 元 素 ， 
可 以 为 稀 玖 。 内 while 循环 在 循环 的 根部 终止 ， 它 为 连 
FF p(k) 和 s(F) 的 最 高 编号 数 ( 共 祖 ) ， 如 果 没 有 其 
他 共 祖 ， 则 它 为 固定 基 。 通 过 方程 式 (2.110), Æ 
对 坐标 系 下 计算 出 I 后 ,第 二 循环 终止 。 
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#211 闭环 约束 算法 


inputs: model, RNEA partial results 
output: L, I 
model data; Ng, p(i), Nj, p(k), s(k), LB(i), 
X4 (5) , X5 (k) , K,, K, 
RNEA data; 9,,X,5, Vick)» Vs(k) > ayy? ai 
for i-1 to Np do 
if p( i) 40 then 
‘Xo ='X o P Xo 
end 
if LB (i) #null then 
°@, -'x-! o, 
end 
end 
L-0 
for k=N, +1 to N; do 
izp(k) 
j=s(k) 
while i 4; do 
if i >j then 


_s(k) y-1 (k) y -lav 
a, =°" Xo ai x X; ay) 
Ls) y-1 _ p(k) y -1 
v, =°" Xo Vs X; MUS 

k)y-ly- s(k 
p, =x_to_vee (? Xo! X5! (k) X (k) ? Xo) 


I, = -a, - Kv, - K,p. 


2.7 结论 与 扩展 阅读 


本 章 提出 了 应 用 于 机 器 人 机 构 的 刚体 动力 学 基本 
原理 ， 主 要 包含 以 下 主题 : 空间 矢量 代数 ， 它 提供 了 
用 于 描述 和 实现 动力 学 方程 及 算法 的 简明 记 法 ; 机 器 
人 学 中 最 常用 的 运动 正则 方程 ， 如 何 构 建 机 器 人 的 动 
力学 模型 ; 几 个 基于 模型 的 有 效 算法 ， 用 于 计算 逆向 
动力 学 、 正 向 动力 学 ， 以 及 关节 空间 和 操作 空间 惯性 
和 矩阵。 

另外 还 有 许多 动力 学 领域 的 主题 本 章 没有 提 及 ， 
但 会 在 本 书后 面 章节 中 讲述 。 有 关 弹 性 连 杆 和 关节 的 


Th 


机 器 人 动力 学 问题 见 第 13 3E; 动态 模型 参数 识别 问 
题 见 第 14 章 ; 第 27 章 讲述 了 机 器 人 与 外 界 目 标 之 间 
物理 接触 的 动力 学 问题 ; 第 45 章 讲 述 了 具有 浮 基 的 
机 器 人 动力 学 问题 。 

在 本 章 结束 之 际 ， 做 一 些 阅 读 提示 ， 机 器 人 运动 
学 简 史 见 参考 文献 [2. 32] ， 更 多 涉及 机 器 人 动力 学 
的 问题 可 以 从 这 些 书 籍 中 找到 ， 见 参考 文献 [2. 8， 
10，15，28，33-35] 。 最 后 ， 对 扩展 阅读 提出 如 下 
建议 。 


2.7.1 多 体 动力 学 


机 器 人 动力 学 可 视 为 更 为 广泛 的 多 体 动力 学 学 
科 的 一 个 子 集 或 一 种 具体 应 用 。 有 关 多 体 动力 学 的 
书籍 包括 参考 文献 [2.3, 14, 31, 3-41], 4R, 
多 体 动 力学 又 是 经 典 力 学 的 一 个 子 集 ， 它 的 数学 基 
础 可 以 在 任意 一 本 经 典 力学 的 书 中 找到 ， 如 参考 文 
献 [2.13]。 


2.7.2 替代 表示 法 


本 章 采 用 空间 矢量 来 表示 运动 方程 。 男 外 还 有 各 
种 可 选 的 替代 方法 用 于 空间 矢量 表示 ， 如 其 他 类 型 的 
六 维 矢量 、 三 维 矢 量 、4 x4 矩阵 以 及 空间 算 子 代数 
等 。 所 有 的 六 维 矢量 形式 是 相似 的 ， 但 又 不 完全 相 
同 。 主 要 的 供 选 方案 有 : HE RC. 4 R 
dU 、 李 代数 呈 2  ， 以 及 一 些 特 别 的 记 法 ， 其 中 

种 特别 记 法 是 将 三 维 矢 量 都 组 成 对 ， 用 以 减 小 代数 
式 的 体积 。 三 维 矢 量 形式 用 于 大 多 数 经 典 力 学 和 多 体 
教科 书 中 ， 它 也 是 六 维 矢 量 和 4 x4 矩阵 的 前 身 。4 x 
4 矩阵 在 机 器 人 学 领域 广 受 欢迎 ， 因 为 它 非 常 适 用 于 
运动 学 ， 但 对 动力 学 则 没 那 么 有 用 。4 x4 FMEA SII 
力学 公式 见 参考 文献 【2.33，44，45]。 空 间 矢 量 代 
数 由 JPL 实验 室 (Jet Propulsion Laboratory ) 的 
Rodriguez 等 人 提出 ， 它 采用 6N 维 矢 量 和 6N x ON JB 
阵 ， 后 者 被 当做 一 个 线性 算 子 ， 这 种 记 法 的 例子 见 参 
考 文献 [2. 46-48] 。 
替代 公式 
本 章 采 用 的 运动 方程 矢量 公式 通常 称 作 牛顿 - 欧 
拉 公式 。 主 要 的 替代 公式 为 拉 格 朗 日 公式 ， 其 运动 
方程 通过 拉 格 朗 日 方程 得 到 ， 拉 格 朗 日 公式 的 例子 
见 参考 文献 [2.9，10，17，49,，50]。 另 外 ， 凯 恩 
(Kane) 方法 也 可 于 机 器 人 学 中 号] 


因为 实时 执行 ， 特 别 是 实时 控制 的 需 


2.7.3 


2.7.4 


BL ait 
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人 界 非 常 关注 计算 的 效率 问题 。 对 于 逆向 动力 学 ， 
Luh 等 人 的 O(n) 递归 牛顿 - 欧 拉 算法 (RNEA) 45 
然 是 最 重要 的 算法 ， 该 算法 的 进一步 改进 见 参考 文 
献 [2.53，54]。 对 于 正 向 动力 学 ,本章 列 举 的 两 
种 算法 ， 仍 可 作为 计算 中 的 重点 考虑 : Featherstone 
提出 的 O(n) XT (ABA) ^U, DUX Walker 
和 Orin 的 基于 复合 刚体 算法 (CRBA) ffl O(n’) 
AUS, ABA 方法 经 过 多 年 改进 和 552 ， 对 于 
n 值 很 小 的 情况 ， 它 比 CRBA 效率 更 高 。 然 而 ， 随 
着 近年 CRBA EA 4r 3c fiae Bh Bg [6] L7 77 和 机 器 
AGE AE HABA?! CRBA 方法 的 优势 逐 
渐 展 现 。 

对 于 关节 空间 惯性 矩阵 ，CRBA 仍 是 目前 最 重要 
ARIK?! ， 多 年 来 也 进行 了 若干 改进 和 修正 ， 以 提 
高 计算 效率 ”3 。 对 于 操作 空间 惯性 和 矩阵， 提出 
TAB O(n) 算法 22 2 ， 并 应 用 于 日 益 复 杂 的 
RR?” 。 


2.7.5 精度 


精度 问题 主要 涉及 动力 学 算法 的 数值 精度 、 模 拟 
精度 〈 即 数值 积分 精度 ) ， 以 及 动力 学 模型 精度 。 与 
效率 相 比 ， 动 力学 算法 的 数值 精度 很 少 受 到 关注 。 虽 
然 RNEA、CRBA 和 ABA 都 已 通过 了 各 种 刚体 系统 的 
精度 测试 ， 但 还 不 能 说 其 他 算法 都 能 通过 测试 。 刚 体 
系统 经 常 是 病态 的 ， 在 这 个 意义 上 ， 一 个 小 的 外 力 变 
化 (或 者 模型 参数 变化 ) ， 就 会 导致 加 速度 的 很 大 变 
化 。Featherstone 研究 了 这 一 现象 呈 26] ， 他 发 现 随 着 
构件 数 的 增加 ， 病 态 情 形 会 变 差 ， 在 最 坏 的 情况 下 ， 
病态 增长 与 0( 巡 ) 成 正比 。 关 于 这 一 主题 的 其 他 文 
献 见 参 考 文献 [2.8, 30, 59, 60]. 


2.7.6 软件 包 


对 于 多 体系 统 ， 特 别 是 机 器 人 系统 ， 已 开发 了 许 
多 软件 包 ， 用 于 动力 学 问题 的 仿真 。 为 积分 方便 ， 其 
中 一 些 是 用 MATLAB 9 编写 的 用 于 分 析 、 控 制 及 仿 
真 的 程序 。 这 些 程序 大 多 都 是 开源 的 ， 有 些 则 是 以 很 
低 的 价格 提供 给 用 户 。 这 些 软件 能 力 上 的 不 同 主要 体 
现在 计算 速度 、 拓 扑 及 关节 模型 支持 、 精 度 、 基 本 的 
动力 学 公式 及 相关 的 复杂 度 、 用 户 界面 图 形 支持 、 数 
值 积 分 程序 、 与 其 他 代码 的 集成 、 应 用 支持 、 价 格 
等 。 其 中 常用 的 软件 包 有 : Adams", Autolev^ ® , 


[2.64] 


DynaMechs ^9 | Open Dynamics Engine 、 Robotics 


Studio! . Robotics Toolbox? 5 、 SD/FAST'? 9! . 


SimMechanics ^ 9! ， 以 及 Webots ^ 9! , 
2.7.7 符号 简化 


符号 简化 技术 采用 通用 的 动力 学 算法 ， 经 符号 处 
理 后 用 于 具体 的 动力 学 模型 ， 其 结果 为 一 个 任务 陈述 
列表 。 要 是 该 算法 以 前 曾经 执行 过 ， 列 表 就 会 详细 列 
出 算法 现在 将 要 如 何 运 行 ， 然 后 检查 和 修剪 所 有 不 必 
要 的 计算 , 余下 的 有 用 程序 用 计算 机 源 代码 形式 输出 
到 一 个 文本 文件 中 。 这 个 生成 的 代码 在 运行 时 比 采 用 
原始 通用 算法 的 代码 要 快 10 倍 ， 但 这 只 适用 于 具体 
的 单个 动力 学 模型 。Autolev2 2 和 S/DFASTÜ 9? cp 
都 采用 这 种 技术 ， 其 他 有 关 动 力学 符号 简化 的 出 版 物 
包括 参考 文献 【2.70-75] 。 


2.7.8 ”并行 计算 算法 


为 加 快 动力 学 计算 速度 ， 开 发 了 许多 算法 用 于 
并 行 计算 机 和 流水 计算 机 。 对 于 逆向 动力 学 ， 早 期 
的 工作 集中 在 将 O (n). RNEA HA) n A Ak H ik 
£27677 ， 随 后 出 现 了 Olog,n) SE, HF 
FA O(n?) CRBA 计算 关节 空间 惯性 矩阵 ， 起 初 是 对 
n 个 处 理 器 ， 用 O(logon) 算法 计算 复合 刚体 惯量 和 
RARER RTA TER 7 8! ， 后 来 对 O(n?) 个 处 理 器 采 
用 O(log,n) 算法 计算 整个 矩阵 1 对 于 正 向 动 
力学 ， 多 机 械 臂 系统 的 加 速 ， 主 要 依靠 并 行 /流水 超 
级 计算 机 获得 呈 ” 。 这 方面 起 初 开 发 了 个 处 理 器 的 
O(logn) SEXE, PAF FCP SCY B (BEC U,. finm 
研究 主要 集中 在 用 O(log, n) 算法 处 理 更 为 复杂 的 
M P 8087) 


2.7.9 变 拓 扑 系统 


许多 机 咒 人 机 构 ， 其 拓扑 结构 会 随时 间 变 化 ， 因 
为 接触 条 件 (特别 是 外 界 环境 ) 发 生 了 变化 ， 如 在 
有 腿 车 中 ， 采 用 柔性 地 面 接触 模型 来 计算 接触 力 ， 可 
将 闭环 结构 简化 为 树 结构 ， 然 而 遇 到 接触 面 很 坚 
硬 的 情况 ， 就 会 产生 数值 积分 问题 。 最 近 的 研究 工 
Met) ， 提 出 了 硬 接 触 约束 假设 。 采 用 这 种 方法 可 
大 大 减少 坐标 变量 的 个 数 ， 而 这 些 变量 数 在 通用 运动 
分 析 系 统 中 ， 则 可 能 是 必须 的 3。 同时 ， 当 结构 变 
化 时 ， 它 们 能 自动 识别 变量 ; 在 构 型 改变 后 ， 能 提出 
相应 的 方法 ， 用 于 计算 速度 边界 条 件 T, 
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第 3 重 ”机构 与 驱动 


Victor Scheinman, J. Michael McCarthy 


3.1 概述 


AB 
机 械 结 构 或 者 机 械 装置 。 而 电动 机 、 液 压 活塞 或 气压 


通常 把 诸如 横梁 、 连 杆 、 和 铸件 、 轴 、 滑 轨 和 轴承 
产生 可 移动 骨架 的 物理 结构 ， 称 为 一 个 机 器 人 的 


活塞 以 及 其 他 可 以 使 这 些 机 械 装置 的 连接 部 分 运动 的 
元 素 则 称 之 为 驱动 装置 。 在 本 章 中 ,我们 主要 考虑 机 
器 人 机 械 装置 以 及 驱动 装置 的 多 种 多 样 的 设计 ， 正 是 
它们 实现 了 一 整套 可 以 将 电脑 命令 转化 为 千变万化 的 


物理 运动 的 功能 。 


早期 设计 的 机 器 人 都 具 


nm 58 


般 的 运动 能 力 ， 因 为 


设计 者 们 认为 如 果 一 个 机 器 人 可 完成 最 多 样 化 的 任务 
类 型 ， 那 么 它 可 找到 的 市 场 也 最 广 。 然 而 这 种 过 于 强 


调 市 场 适应 性 的 设计 导致 了 制造 和 使 


的 高 成 本 。 现 


在 的 机 器 人 更 多 的 是 仅仅 半 绕 一 个 特定 系列 的 任务 开 


6 进行 设计 。 


机 器 人 设计 关注 的 是 关节 的 数量 、 外 形 大 小 、 负 
载 能 力 和 末端 执行 器 所 需 的 运动 条 件 。 运 动 结构 的 构 
造 和 机 器 人 的 总 体 大 小 是 由 其 所 要 完成 的 任务 的 需 
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求 、 工 作 空 间 以 及 其 本 身 的 再 适应 能 力 决 定 的 。 这 些 
等 点 都 影响 到 了 末端 执行 器 路 径 控制 的 精度 ， 而 此 精 
度 在 弧 焊 和 喷漆 机 器 人 的 平滑 运动 的 过 程 中 都 需要 得 
到 保证 。 同 时 ， 它 们 也 决定 了 进行 装配 所 必需 的 完全 
的 定位 能 力 、 进 行 材料 处 理 所 必 需 的 可 重复 能 力 以 及 
进行 精确 的 、 实 时 的 、 基 于 传 感 装置 的 运动 所 必需 的 
高 分 辨 率 和 精确 度 。 

在 进行 机 器 人 系统 设计 时 我 们 所 要 考虑 的 一 个 十 
分 关键 的 问题 就 是 我 们 到 底 想 要 这 个 机 器 人 完成 多 少 
任务 。 这 个 机 器 人 被 设计 具有 的 适应 性 应 该 可 以 顺利 
地 完成 这 一 范围 内 的 任务 。 这 决定 了 这 个 机 融 人 的 机 
械 装置 拓扑 设计 和 驱动 系统 。 而 几何 形状 、 材 料 、 传 
感 吉 的 选择 ， 包 括 电线 线路 径 的 设计 都 要 基于 这 些 最 
根本 的 决定 因素 。 


3.2 系统 特征 


工作 范围 和 负载 能 力 是 赋予 一 个 机 器 人 各 种 特质 
的 最 主要 的 特征 。 


3.2.1 工作 范围 


机 器 人 工作 范围 的 定义 是 机 器 人 自己 可 以 进行 操 
作 的 空间 ， 其 中 便 包 含 了 工作 空间 的 定义 。 工 作 空 间 
通常 定义 了 机 器 人 的 位 置 和 方向 以 便 其 完成 指定 的 任 
务 ， 而 工作 范围 在 此 基础 上 还 包括 机 器 人 自己 运动 时 
所 占据 的 空间 体积 。 这 个 范围 是 由 关节 的 类 型 、 关 节 
运动 的 区 间 和 连接 它们 的 连 杆 长 度 所 决定 的 。 在 设计 
机 器 人 的 机 械 结构 时 ， 工 作 范 围 的 大 小 以 及 机 器 人 上 
的 负载 大 小 是 我 们 首要 考虑 的 问题 。 

机 絮 人 工作 范围 的 设计 必须 要 考虑 到 机 械 结构 
的 运动 可 能 会 受到 限制 的 部 分 。 这 些 约束 来 源 于 关 
节 运 动 范 围 的 有 限 性 、 连 杆 长 度 、 轴 间 夹 角 或 者 这 
些 因素 的 综合 作用 。 一 般 来 说 ， 转 动 关节 机 械 臂 在 
工作 范围 的 中 间 会 比 在 其 极限 位 置 有 更 好 的 工作 效 
果 《〈 见 图 3.1) 。 机 械 臂 的 长 度 和 关节 的 移动 范围 之 
间 应 该 留 出 一 定 的 空 阶 ， 以 便 在 传感器 的 引导 下 形 
成 各 种 各 样 的 移动 路 径 ， 并 且 为 末端 执行 器 或 工具 


图 3.1 PUMA 560 机 器 人 


加 速度 和 刚度 (结构 和 了 驱动 刚度 ) 与 峰值 速度 和 最 
大 负载 能 力 相 比 往往 是 更 为 重要 的 参数 。 而 弧 焊 时 
所 需要 的 是 在 控制 路 径 上 缓慢 的 移动 ; 同时 ， 速 度 
的 细微 变化 和 跟踪 焊接 路 径 的 准确 性 都 十 分 重要 。 
因此 ， 人 们 更 应 当 依据 一 个 操作 装置 的 有 效 载 荷 特 
性 ， 而 不 是 最 大 载荷 ,来 进行 操作 装置 的 设计 和 
确定 。 

规定 负载 能 力 时 必须 将 末端 执行 器 的 重力 和 惯 
性 力 列 和 人 考虑 范围 。 这 些 因素 将 对 腕 关节 、 末 端 执 
行 器 的 设计 和 了 驱动 部 分 产生 很 大 影响 。 一 般 情 况 下 ， 
负载 能 力 在 机 械 辟 加 速度 和 腕 关节 扭矩 的 方面 相对 
其 他 因素 更 加 重要 。 负 载 情况 也 会 影响 到 机 械 臂 静 
态 结构 的 变形 、 电 动机 转 矩 的 稳定 性 、 系 统 回 有 频 
率 、 误 减 及 伺服 系统 控制 变量 的 选择 。 这 些 因素 都 
对 机 器 人 是 和 否 能 够 实现 最 好 的 运行 效果 和 稳定 性 起 
到 重要 作用 。 


3.2.3 ”运动 骨架 


机 械 臂 的 形状 和 大 小 是 由 其 工作 空间 的 形状 、 布 
局 ,运动 的 精确 程度 ， 速 度 和 加 速度 及 其 结构 的 需求 
共同 决定 的 。 笛 卡 儿 坐 标 下 的 机 械 臂 〈 腕 关节 的 轴 
可 旋 或 不 可 旋 ) 拥有 最 简单 的 变形 和 控制 方程 。 它 
们 移动 的 (直线 运动 的 ) 、 垂 直 的 轴 使 运动 的 规划 和 


的 更 换 提 供 方便 ， 和 否则 偏 移 量 和 长 度 的 不 同 将 经 党 
改变 工作 范围 。 
负载 能 

作为 机 器 人 最 主要 的 特征 之 一 ， 负 载 能 力 与 速 
度 和 加 速度 有 着 非常 密切 的 关系 。 对 于 装配 机 絮 人 


来 说 ， 首 要 任务 是 保证 位 置 精度 ， 将 一 个 简单 的 抓 
取 - 释放 动作 循环 的 时 间 减 到 最 小 ， 因 此 机 械 结构 的 


3. 2.2 


计算 变 得 简单 旦 相对 直接 。 因 为 他 们 的 主 运动 轴 没 有 
进行 动力 的 耦合 〈 在 原始 设置 下 ) ， 所 以 他 们 的 控制 
方程 也 被 大 大 简化 了 。 具 有 全 部 转动 关节 的 机 械 臂 通 
常 更 难以 控制 ， 但 是 他 们 在 给 定 的 工作 空间 中 却 可 使 
结构 更 紧凑 和 高 效 。 一 般 情 况 下 ， 设 计 和 制造 一 个 转 
动 关 节 比 一 个 长 时 间 运 动 的 移动 关节 更 加 容易 。 相 比 
龙门 型 机 器 人 ， 有 具有 转动 关节 机 械 臂 的 机 器 人 的 工作 
空间 能 够 更 加 方便 地 与 经 过 调节 的 直角 坐标 型 机 器 
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人 装置 进行 重 和 至。 

机 器 人 结构 的 最 终 选 择 应 该 基于 专门 的 运动 、 结 
构 或 者 任务 执行 的 需要 。 比 如 ， 当 需要 进行 一 个 非常 
精确 的 垂直 直线 的 运动 时 ， 我 们 会 选择 一 个 简单 的 棱 
柱 垂直 关节 轴 而 不 是 两 个 或 三 个 需要 协调 控制 的 转动 
关节 。 

想 要 使 一 个 机 器 人 机 械 辟 的 末端 执行 右 能 够 达 
到 其 工作 空间 中 的 任意 方向 和 位 置 ， 最 少 需要 6 个 
自由 度 。 当 然 ， 大 多 数 简单 的 或 预 设 好 的 任务 所 需 
的 自由 度 也 可 以 少 于 6 个 。 这 是 因为 他 们 可 以 经 过 
精心 的 设计 来 减少 特定 轴 的 运动 ， 或 者 这 项 任务 并 
不 需要 用 到 空间 中 所 有 的 位 置 。 一 个 典型 的 例子 便 
是 垂直 装配 机 器 人 使 用 螺钉 旋 具 时 的 情况 ， 它 仅 需 
要 三 个 自由 度 。 

在 有 些 应 用 中 ， 我 们 需要 在 多 于 6 个 自由 度 的 情 
况 下 运用 机 械 臂 ， 特 别 是 需要 机 动 性 或 绕 开 一 些 障 得 
物 的 时 候 。 例 如 ， 一 个 管道 外 壁 涂料 维护 机 融 人 不 仅 
需要 控制 其 形状 还 需要 控制 末端 执行 器 的 精确 走 位 。 
一 般 来 说 ， 添 加 自由 度 会 使 循环 时 间 增 长 ， 减 少 负 载 
能 力 并 降低 给 定 的 机 械 辟 结构 和 驱动 系统 的 精确 
程度 。 


3.3 运动 学 与 动力 学 
机 器 人 的 动力 系统 可 以 分 为 两 个 部 分 : 一 部 分 
依赖 于 其 机 械 结构 的 几何 特征 以 及 作用 在 其 结构 上 
的 力 ， 反 映 了 机 器 人 的 运动 特质 ， 称 为 运动 学 ; 另 
一 部 分 则 通过 力 对 系统 产生 作用 ， 称 为 动力 学 。 动 
力学 中 的 一 条 基本 法 则 告诉 我 们 : 运动 机 器 人 能 量 
的 改变 和 外 力 在 其 上 做 的 功 之 间 的 差异 在 运动 轨迹 
的 细小 变化 过 程 中 保持 不 变 。 这 就 是 虚 功 和 虚 状态 
原理 ， 它 要 求 在 所 有 的 虚 位 移 上 功 与 能 量 的 变化 相 
Hd, 

由 于 像 机 右 人 这 样 的 机 械 都 尽量 设计 得 使 能 量 损 
失 最 小 化 ， 其 能 量 损失 一 般 源 于 关节 的 摩擦 和 材料 的 
疲劳 ， 所 以 我 们 可 以 认为 能 量 的 变化 量 是 很 小 的 。 这 
就 意味 着 驱动 装置 所 输入 的 功 几乎 能 够 全 部 转化 为 输 
出 的 力 所 做 的 功 。 

如 果 在 一 段 微小 的 时 间 里 考虑 这 种 关系 ， 我 们 可 
以 得 到 输入 功 的 速率 ， 即 功率 ， 近 似 等 于 相应 的 输出 
功率 。 因 为 功率 等 于 力 乘 以 速度 ， 我 们 便 得 到 了 最 基 
本 的 关系 : 输入 力 与 输出 力 的 比值 和 输入 速度 与 输出 
速度 的 比值 互 为 倒数 。 另 一 种 表述 方式 为 ， 对 于 理想 
的 机 械 ， 机 械 增益 等 于 其 速度 比值 的 倒数 。 


3.3.1 机 器 人 拓扑 


铵 接 的 或 可 滑 移 的 关节 与 连 杆 组 成 链 状 结构 ， 一 
系列 这 样 的 链 状 结构 又 组 成 了 机 器 人 的 运动 骨架 。 这 
种 骨架 一 般 具 有 两 种 基本 形式 : 如 果 是 由 单一 连续 的 
链 状 结构 组 成 ， 就 定义 为 串联 机 器 人 ( 见 图 3.1); 
而 如 果 是 多 个 连续 的 链 状 结构 共同 支持 同一 个 终端 控 
制 装置 ， 如 图 3.2 所 示 ， 我 们 称 之 为 并 联机 器 人 。 机 
器 人 经 过 设计 可 以 实现 并 联 工作 ， 比 如 一 个 行走 机 器 
人 的 腿 部 〈 见 图 3.3 AIEI 3. 4) 93) 和 一 个 机 器 人 手 的 
多 个 手指 〈 见 图 3.5~ 图 3.7)04。 


平台 


图 3.2 一 个 并 联机 器 人 ， 可 以 有 多 达 6 个 串联 链 
将 一 个 末端 平台 连接 到 基 座 


图 3.3 有 自 适 应 能 力 的 悬挂 式 车 型 行走 机 器 人 


机 咒 人 的 末端 执行 咒 是 与 环境 进行 交互 的 首选 工 
具 ， 而 它 的 定位 和 定向 则 需要 依赖 于 机 器 人 的 运动 骨 
架 。 对 于 一 个 普通 的 串联 机 器 人 来 说 ， 一 个 具有 六 关 
节 的 链 状 结构 便 可 以 提供 对 其 终端 装置 的 全 部 控制 。 
而 对 于 一 个 普通 的 并 联机 器 人 ，6 个 关节 往往 不 够 ， 
同时 六 个 驱动 装置 还 需要 通过 与 关节 不 同 的 关联 方式 
来 实现 对 于 其 终端 装置 运动 的 控制 。 
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图 3.6 Salisbury 手 作 为 PUMA 机 器 人 的 末端 执行 器 
(图 上 未 展示 驱动 系统 ) 


图 3.7 Salisbury 三 指 手 在 抓 取 物体 时 的 照片 


3.3.2 运动 学 方程 

通过 其 运动 学 方程 ， 机 器 人 可 以 用 它 自己 各 关节 
的 详细 参数 ， 比 如 旋转 关节 转 过 的 角度 和 滑动 关节 移 
动 的 距离 ,来 定义 一 个 机 械 任意 组 成 部 分 的 位 置 。 要 
做 到 这 点 ， 我 们 需要 用 一 系列 的 线条 来 描述 机 器 人 。 
这 些 线条 代表 着 相互 等 价 的 旋转 或 者 楼 形 关 节 的 
轴 和 公 垂 线 邹 ， 而 后 两 者 则 组 成 了 整个 链 状 结构 的 运 
动 骨架 ( 见 图 3.2)。 这 样 的 结构 可 以 使 机 器 人 的 每 
个 连 杆 的 详细 位 置信 息 通过 下 面 的 矩阵 方程 与 基准 产 
生 联 系 : 

T -Z(0,, d,)X(a,, a,)Z(0,, d)... x 

X(a, ,, a, 1)Z(0,, dn) (3.1) 
这 就 是 链 状 结构 的 运动 方程 8554 (参见 第 1 章 式 
(1.44) ) 。 由 所 有 的 关节 参数 所 确定 的 所 有 末端 执行 
器 所 能 到 达 的 位 置 7 的 集合 被 称 为 机 器 人 的 工作 
空间 。 

Z(6,, dj) füX(oj, aj) 都 为 4x4 的 矩阵 ， 分 
别 定义 了 绕 着 和 沿 着 关节 轴 与 六 的 旋转 位 移 
HOT, HWS o, a 确定 了 链 中 连 杆 的 维度 。 
6, 代表 旋转 关节 的 角度 变量 ， 而 d, WERE XH 
位 置 变 化 量 。 末 端 执行 器 上 一 点 入 的 轨迹 'p(1) 可 
以 通过 关节 的 轨迹 获得 ， 满 足 如 下 公式 : 


"p(t) 2 T(q(1))"p (3.2) 
式 中 ,gq(?) = (gy) pose m)", uo 0E d; 
则 依照 具体 关节 而 定 。 


如 果 未 端 执 行 器 与 基准 框架 是 通过 多 于 一 个 的 串 
联 链 状 结构 连接 的 ( 见 图 3.2)， 那 么 对 于 每 一 个 链 
结构 来 说 我 们 都 有 一 套 运 动 方程 ， 

T-BT(q)E, j=1,...,n (3.3) 
Uh, B, 确定 了 第 j 个 链 的 基 坐 标 ; EE XT C 
末端 执行 器 的 连接 位 置 。 那 些 能 够 同时 满足 所 有 这 
些 方程 的 T 组 成 的 集合 就 是 末端 执行 器 的 工作 空 
间 。 这 给 关节 的 变量 增加 了 约束 ， 这 些 约束 必须 先 
被 确定 下 来 才能 完整 地 定义 末端 执行 器 的 工作 


zx[gp ^51, 
3.3.3 Hsia) 


一 个 机 器 人 的 构 型 空间 指 的 是 可 以 使 用 的 关节 参 
数值 的 范围 ， 而 运动 方程 将 它 与 末端 执行 器 的 工作 空 
间 联 系 在 了 一 起 。 这 个 构 型 空间 是 设计 机 器 人 躲避 障 
和 碍 路 径 的 基本 工具 1°) 。 虽 然 组 成 机 器 人 的 链 状 结构 
中 的 任何 一 个 连 杆 都 有 可 能 与 隐 碍 物 发 生 碰撞 ， 但 
是 只 有 未 端 执行 器 是 设计 来 靠近 这 些 障碍 物 并 实现 
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其 功能 的 ， 这 些 障 碍 物 如 支撑 机 器 人 的 桌子 和 所 要 
抓 取 工件 的 夹具 等 。 由 于 障碍 物 的 存在 ， 工 作 空间 
中 出 现 了 一 些 禁 止 到 达 的 位 置 和 方向 。 与 其 对 应 ， 
机 器 人 的 构 型 空间 中 也 出 现 了 不 能 实现 的 关节 夹 角 。 
所 以 ,机 器 人 工作 路 径 的 设计 者 就 必须 要 在 除了 这 
些 关 节 障 碍 的 其 他 自由 空间 中 来 寻找 一 条 能 够 到 达 
目的 地 的 路 径 。 


速度 比 
机 器 人 的 速度 比 将 末端 执行 器 上 一 点 刀 的 速 


Hp 与 关节 的 速率 4 -(q4,,..., qa) 建立 了 联 
系 ， 方 程 为 : 


3.3.4 


“PP =v +@x('p-d) (3.4) 
式 中 ,d 为 参考 点 的 位 置 ; v 为 参考 点 的 速度 ;w 是 末 
端 执行 器 的 角速度 。 

向 量 v 与 co 可 通过 下 列 方程 与 关节 速率 q, 建立 
联系 : 


ðv ðv ðv : 
: n q 
v 9q, ðq, ðq : 
- : (3.5) 
e ðw ðw óc 
aq, ðq qn) Nd 
或 
v=Jq (3.6) 


式 中 ,系数 矩阵 J 称 为 雅 可 比 和 矩阵 。 它 作为 速度 比 矩 
阵 , 建 立 起 了 末端 执行 器 速度 与 输入 的 关节 旋转 速率 
之 间 的 关系 "1。 


3.3.5 ”机 械 增益 


如 果 末 端 执行 右 在 点 'p 上 作用 了 的 力 ,那么 输出 
功率 为 : 


ve = ð óc 7 $ 
Pa =f -"p = Yr. [x Cp h, 
j=l ðq; ðq; 


(3.7) 
如 果 关 节 S, 处 有 驱动 装置 , 则 上 述 和 式 中 的 每 一 项 都 
是 其 中 某 个 驱动 装置 提供 的 功率 在 总 输出 功率 中 所 占 
的 那 部 分 。 
关节 S, 处 输入 的 功率 是 转 矩 T, 与 角速度 9 的 
乘积 五 9))。 对 每 一 个 关节 运用 虚 功 原理 ,我 们 可 以 
得 到 : 


-22 (p-d) xf- 2, j=1,,m. 
er 997 


(3.8) 
我 们 可 以 利用 此 公式 在 参考 点 d 引入 力矩 矢量 fT= (f, 


(p-d) xf)". 
方程 式 (3.8) 可 变形 为 矩阵 形式 : 
T-J'f (3.9) 
WP, J 为 式 (3.5) 中 定义 过 的 雅 可 比 和 矩阵 。 对 于 
一 个 具有 六 关节 的 链 结构 来 说 ， 运 用 这 个 方程 可 以 解 
得 输出 力矩 矢量 f， 
f=(J) T (3.10) 
因此 ， 用 和 矩阵 定义 的 这 个 系统 的 机 械 增益 为 速度 
LEA PERS SERRE 


3.4 串联 机 器 人 


串联 机 融 人 是 以 底座 为 开始 ， 以 末端 执行 铝 为 结 
东 的 一 系列 连 杆 和 关节 ， 如 图 3. 8 所 示 。 机 器 人 的 连 
杆 和 关节 常常 被 设计 成 可 以 提供 独立 平移 和 定 方向 的 
结构 。 通 常情 况 下 ， 前 3 个 关节 一 般 用 来 在 空间 定位 
一 个 参考 点 ， 后 3 个 关节 用 来 组 成 可 以 确定 这 个 点 附 
近 的 末端 执行 器 方向 的 腕 关节 ”” 。 这 个 参考 点 被 
叫做 腕 坐标 中 心 。 腕 坐标 中 心 所 能 够 到 达 的 空间 被 叫 
做 机 器 人 的 可 达 工 作 区 。 到 达 这 些 点 且 可 旋转 的 空间 
称 为 灵巧 工作 空间 。 


图 3.8 Salisbury 的 一 根 手指 是 一 个 串联 机 器 人 


一 个 机 器 人 往往 设计 成 它 的 可 达 工 作 区 是 对 称 
的 。 从 这 个 角度 看 ， 有 三 种 基本 形状 : 矩形、 圆柱 形 
和 球形 。 和 矩形 工作 区 是 由 3 个 相互 垂直 的 移动 (P) 
关节 组 成 。 这 些 关 节点 可 构成 所 谓 的 笛 卡 儿 型 机 器 人 
的 PPPS ££, Rh S 指 的 是 一 个 允许 相对 于 其 中 心 点 
所 有 方向 转动 的 球形 铵 链 的 腕 关节 。 旋 转 的 底座 和 两 
个 移动 关节 点 可 构成 一 个 具有 圆柱 工作 区 的 CPS 链 ， 
其 中 C 指 的 是 共 轴 的 旋转 (R) 和 滑 移 (P) 关节 
点 。P 关节 可 被 一 个 作为 肘 关 节 的 、 由 提供 相同 径 向 
运动 的 转动 (R) 关节 所 替代 。 最 后 ， 两 个 相互 垂直 
的 旋转 关节 在 机 器 人 的 底座 上 组 成 一 个 T 形 关节 ， 这 
个 关节 可 支持 围绕 横向 和 纵向 转轴 的 旋转 。 径 向 移动 
既 可 以 由 了 关节 点 提供 也 可 以 由 作为 肘 的 R 关节 点 
提供 ， 它 便 构 成 了 一 个 具有 球形 工作 空间 的 TPS 链 
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8k TRS f£, 

工作 区 间 的 完全 对 称 是 很 少 能 实现 的 ， 因 为 
关节 的 轴线 往往 需要 为 避免 连 杆 的 碰撞 而 偏 置 ， 
而 且 还 存在 与 工作 区 间 扭 曲 变形 相关 的 关节 运动 
限制 。 


3.4.1 设计 优化 

另 一 种 设计 机 器 人 的 方法 是 用 机 器 人 工作 区 间 
的 直接 规格 参数 作为 系统 的 末端 执行 器 的 位 置 集合 ， 
我 们 称 之 为 任务 空间 "1 。 一 般 串 联机 械 辟 对 于 
其 上 的 5 个 连 杆 的 每 个 连 杆 就 有 两 个 设计 参数 ， 连 
杆 偏 移 和 扭转 ， 这 5 个 连 杆 中 ， 每 个 都 具有 4 个 可 
以 指示 机 器 人 底座 和 其 末端 执行 器 上 工件 位 置 的 参 
数 ， 所 以 总 共有 18 个 设计 变量 。 连 杆 参 数 往往 都 被 
给 定 了 ， 以 保证 工作 链 有 球形 的 腕 和 特定 的 工作 空 
间 。 设 计 目标 通常 是 确定 工作 空间 的 体积 并 且 指 出 
谍 座 和 工件 的 框架 ， 以 便于 工作 空间 能 包含 特定 的 
任务 空间 。 

任务 空间 一 般 由 4 x4 EED, (i=1,…, k) 定 
义 。 利 用 迭代 的 方式 ， 通 过 选择 一 个 设计 ， 并 用 联合 
的 运动 学 方程 T(q) 来 求 得 目标 方程 


Kn = X nro (3.11) 
中 相关 位 移 的 解 。 最 优化 技术 可 以 得 到 使 目标 函数 最 
小 化 的 设计 参数 矢量 x。 
这 种 优化 取决 于 末端 执行 器 和 理想 工作 空间 之 
间 的 距离 度量 的 定义 。Parkt 5!. Martinez 和 Duf- 
fy P 191 ; Zefra ^ ?? , lin, Burdick ^?! 等 人 已 经 告诉 
我 们 没有 距离 度量 是 坐标 的 结构 不 变量 。 这 个 也 就 
是 说 ， 除 非 这 一 目标 函数 可 以 被 化 为 零 ， 使 工作 区 
完全 包含 任务 空间 ， 那 么 最 终 的 结果 将 并 不 能 使 设 
计 与 坐标 的 选择 相互 独立 ， 也 因此 不 能 被 称 为 几何 
的 设计 。 


3.4.2 速度 比 


依据 式 (3.5), ， 六 轴 机 器 人 是 一 个 6 x 6 mm 
可 比 矩 了 泗 ， 一 个 由 速度 比 构成 的 阵列 ， 此 速度 比 的 
意义 便 在 于 将 腕 中 心 速度 v 以 及 末端 执行 器 角速度 
c 与 每 个 关节 的 速度 联系 起 来 。 方程 (3.9) 表明 ， 
从 每 个 驱动 器 提供 的 转 和 矩 的 角度 来 看 ， 这 个 雅 可 比 
矩阵 定义 了 施加 在 腕 中 心 的 转 矩 矢量 f。 机 器 人 的 连 
杆 参 数 可 以 用 来 确定 一 个 具有 特定 属性 的 雅 可 比 
和 矩阵 。 

一 个 机 器 人 的 驱动 转 矩 的 平方 和 通常 被 用 来 作为 


结果 的 一 个 测量 标准 量 **”。 从 式 (3.9) 我 们 
得 到 
TT=F Tf (3.12) 

Xu, AREE JJ" 是 正方 形 的 正定 和 矩阵。 因此 ， 它 可 
以 被 看 成 是 在 六 维 空 间 内 对 超 椭 球体 的 定义 。 这 个 
椭 球 体 的 半径 是 这 个 雅 可 比 矩 阵 特征 值 的 绝对 值 的 
相反 数 。 这 些 特 征 值 可 以 被 看 做 确定 每 个 关节 速度 
与 放大 量 的 模 态 速 度 比 。 其 倒数 是 相关 模 态 的 机 械 
增益 ， 所 以 这 个 椭 球 形状 说 明了 机 器 人 的 力 的 增益 
性 能 。 

最 大 特征 值 与 最 小 特征 值 的 比率 ， 即 所 谓 的 条 件 
数 ， 给 出 了 关于 椭 球 的 各 向 异性 或 失 圆 的 尺度 。 一 个 
球体 的 条 件数 为 1， 称 之 为 各 向 同性 。 当 一 个 机 器 人 
的 末端 执行 器 所 处 的 位 置 所 对 应 的 雅 可 比 和 矩阵 各 向 同 
性 时 ， 就 不 存在 速度 比率 的 放大 或 者 机 械 增益 。 因 为 
误差 是 不 会 被 扩大 的 ， 所 以 这 个 模型 被 认为 可 以 在 输 
入 和 输出 间 提 供 很 好 的 耦合 。 因 此 ， 条 件数 在 机 器 人 
设计 中 也 被 作为 一 个 评价 准则 。 

这 种 情况 建立 在 机 器 人 的 基本 设计 工作 区 间 包 
含 了 其 任务 空间 的 假设 之 上 。 参 数 优化 确定 了 内 部 
的 连 杆 参数 ， 这 些 参数 可 以 产生 一 个 具有 我 们 所 期 
望 的 属性 的 雅 可 比 和 矩阵 。 正 如 我 们 的 设计 与 理想 工 
作 区 间 之 间 的 差距 的 最 小 化 过 程 中 ， 基 于 雅 可 比 矩 
阵 的 优化 也 取决 于 一 个 能 够 避免 坐标 相关 性 的 公式 
化 的 过 程 。 


3.5 并 联机 器 人 


有 两 个 或 两 个 以 上 串联 机 器 人 来 支持 末端 执行 器 
的 机 器 人 系统 被 称 作 并 联机 器 人 。 例 如 ， 自 适应 悬 架 
车 辆 (ASV) ( 见 图 3.9) ， 是 一 种 由 并 联 驱 动 装置 驱 
动 的 缩放 装置 。 

并 联机 器 人 的 每 一 个 支撑 腿 可 有 多 达 6 个 自由 
度 ， 然 而 在 整个 系统 中 一 般 只 有 6 个 关节 受到 驱动 。 
一 个 很 好 的 例子 就 是 Stewart 平台 ， 它 由 6 个 TPS 机 
器 人 组 成 ， 而 在 这 些 TPS 机 器 人 的 关节 中 往往 只 有 了 


关节 是 主动 驱动 的 。 
这 TPS 腿 的 运动 学 方程 是 
T-BI(0)E, j=1, =, 6 (3. 13) 


IP, B, 指 的 是 腿 的 底座 ; E, 则 定义 了 底座 与 未 端 
执行 器 连接 的 位 置 。 能 同时 满足 所 有 这 些 方程 的 位 置 
T 的 集合 便 是 并 联机 器 人 的 工作 区 。 

往往 并 联机 器 人 的 一 个 工作 链 可 以 被 几何 约束 所 
定义 ， 例 如 ， 如 果 位 置 了 满足 方程 
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图 3.9 ASV 步行 机 器 的 一 条 腿 就 是 一 个 并 联机 器 人 


(Tx, -p,) * (Tx, - pj) =p; (3.14) 

那么 了 就 是 属于 第 7 个 TPS 支撑 腿 的 工作 区 。 

为 p; 的 长 度 受 到 了 了 驱动 关节 的 控制 ， 所 以 这 个 方程 

定义 了 基础 关节 pp, 到 平台 上 连接 点 的 距离 。 在 这 种 

情况 下 ， 工 作 区 就 是 满足 所 有 6 个 方程 的 位 置 7 了 的 集 
合 ， 同 时 ， 每 个 腿 都 具有 这 样 一 个 工作 区 。 


3.5.1 工作 区 间 


并 联机 絮 人 的 工作 区 间 是 单个 支撑 腿 的 工作 区 i 
的 交集 。 然 而 ， 这 并 不 是 简单 地 将 可 达 工 作 区 与 灵巧 
工作 区 分 别 独立 相交 。 在 并 联机 器 人 中 ， 这 些 工作 


mj 


> 


3.5.2 ”机械 增益 


通过 考虑 单个 支撑 腿 的 雅 可 比 和 矩阵 ， 我 们 可 以 得 
到 并 联机 器 人 的 力 的 增益 特性 。 利 用 由 6 个 向 量 组 成 
的 v= (v, co) 来 定义 平台 的 线 速度 和 角速度 ， 从 每 
个 支撑 腿 的 运动 学 方程 可 以 得 到 
v=J pi =J, p=" =J (3.15) 
在 这 里 假设 此 平台 有 56 PS SETERR, 但 也 可 以 更 
少 ， 比 如 当 机 械 手 的 手指 抓 住 一 个 物体 时 。 
通过 虚 功 原理 可 得 到 由 每 个 链 提供 给 平台 的 力 
fe) Um. j=1, ,6. (3.16) 
在 系统 中 只 有 6 个 驱动 关节 ， 所 以 我 们 把 这 些 相 
关 的 力矩 都 列 写 到 矢量 T= (T, =, T)" 中 去 。 如 
RE 是 在 =1 且 富余 力矩 为 0 的 条 件 下 通过 式 
(3.16) 得 到 的 力 -力矩 矢量 ,那么 最 终 作 用 在 平台 
上 的 力 -力矩 w 为 
w=(f fft 


(3.17) 

或 者 

w=IT (3. 18) 

系数 和 矩阵 丁 的 元 素 决 定 了 每 个 驱动 关节 的 机 械 
增益 。 在 Stewart 平台 的 例子 中 ， 和 矩阵 中 的 各 列 便 是 
沿 着 各 条 腿 线 条 的 Pliicker 坐标 。 

利用 虚 功 原理 可 以 得 到 用 关节 速率 表达 的 平台 速 
度 函 数 : 


I'v-p (3.19) 

Es ib D Bf p e f E T UC Ae T REL Pg E ay 2B 

置 间 的 速度 比 。 同 样 的 方程 可 以 通过 几何 约束 方程 

(3.14) 的 导数 的 计算 得 到 ， 并 且 万 是 并 联机 器 人 系 
统 的 雅 可 比 矩 阵 。 

这 个 雅 可 比 矩 阵 工 被 应 用 在 参数 优化 算法 中 ， 

以 设计 出 具有 各 向 同性 机 械 增益 的 并 联机 器 人 。 行列 


都 是 密切 结合 的 。 这 些 灵巧 工作 区 一 般 在 可 达 工 作 区 
中 心 附近 最 大 ， 并 且 随 着 参考 点 向 可 达 工 作 区 的 边缘 
移动 而 逐渐 缩小 。 通 过 支撑 腿 的 设计 ， 在 运动 对 称 性 
方面 产生 了 一 个 新 的 关注 焦点 ， 同 时 经 过 很 多 创新 并 
联 设 计 ， 这 个 焦点 已 经 成 为 一 个 重要 的 设计 工 
有 具 ”模拟 系统 是 利用 设计 参数 来 评价 机 器 人 的 
工作 区 间 的 。 

男 一 种 方法 是 直接 指定 工作 区 间 中 的 位 置 和 方 
向 ， 这 些 位 置 和 方向 均 是 确定 腿 的 限制 的 代数 方程 中 
的 参数 ， 而 这 些 腿 的 限制 又 决定 了 设计 参数 3 。 
这 称 为 运动 合成 ， 同 时 产生 出 了 不 对 称 并 联机 器 人 ， 
但 是 此 机 器 人 具有 指定 的 可 达 工 作 区 和 灵巧 工作 区 ， 
参见 MeCarthy ^7 , 


x 


式 |7 的 平方 根 可 测量 由 列 向 量 限定 的 六 维 体 

耻 。 这 个 体积 与 其 在 工作 区 间 中 的 最 大 值 的 比值 的 分 
布 也 被 用 作 衡 量 机 器 人 的 整体 性 能 ”“”'”1 。 通 过 测量 
可 用 的 最 大 关节 扭矩 和 最 大 的 期 望 力 和 力矩 ， 一 个 相 
似 的 性 能 衡量 方式 将 雅 可 比 矩 阵 标 准 化 ， 然 后 再 寻找 
一 个 各 向 同性 的 设计 。 


3.5.3 特殊 并 联机 器 人 


另 一 种 设计 并 联机 器 人 的 方法 是 将 它 的 功能 分 成 
定位 和 移动 两 部 分 。Tsai Joshi“?! . Jin 和 Yang ^" 
调查 设计 了 一 类 只 产生 移动 的 并 联 链 。Kong 和 Gos- 
selin 和 Hess- Coelhof 2 做 了 同样 的 工作 ， 设 计 了 能 
在 空间 中 提供 旋转 运动 的 并 联 链 。 
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3.6 机械 结 构 


为 了 动态 建 模 ， 机 器 人 的 连 杆 通常 被 认为 是 刚性 
的 ， 但 是 机 器 人 并 不 是 刚性 结构 。 像 所 有 的 结构 一 
样 ， 机 器 人 将 在 如 自身 重力 和 载荷 重力 等 在 加 载荷 的 
作用 下 弯曲 ， 见 图 3. 10 和 图 3. 11。 这 种 变形 是 程度 
的 问题 。 导 致 连 杆 弯曲 需要 的 力 越 大 ， 机 器 人 就 越 像 
一 个 由 刚性 结构 构成 的 整体 。 刚 性 机 器 人 的 连 杆 被 设 
计 得 具有 一 定 的 硬度 ， 以 实现 负载 所 造成 的 弯曲 小 于 
其 所 需 完成 的 各 种 任务 对 精确 定位 的 要 求 。 这 样 就 保 
证 了 动态 建 模 和 控制 算法 不 需要 考虑 连 杆 的 变形 。 大 
多 数 商 用 机 器 人 的 手 辟 都 是 这 种 类 型 的 ( 见 参 考 文 
iR [3.44] ) 。 


图 3.11 DeLaval VMS 的 挤 奶 机 器 人 


通过 增加 控制 算法 ， 使 其 包括 由 重力 产生 的 连 杆 
变形 的 模型 ， 我 们 可 以 改进 一 个 刚性 机 器 人 的 定位 精 
度 。 我 们 还 可 以 使 用 压力 传感器 来 衡量 载荷 和 挠 度 。 
这 些 半 刚性 机 器 人 都 假定 了 小 的 结构 变形 与 已 知 的 负 
载 呈 线 性 相关 的 关系 。 

柔性 机 器 人 要 求 动态 模 型 包括 各 个 关节 由 重力 负 
载 所 造成 的 变形 ， 以 及 由 加 速度 产生 的 惯性 力 带 来 的 
载荷 ， 即 所 谓 的 惯性 负载 。 机 器 人 控制 算法 必须 同时 
控制 系统 的 振动 以 及 其 总 体 运 动 。 振 动 的 控制 甚至 在 
刚性 机 器 人 中 也 是 必需 的 ， 以 实现 高 速 和 对 大 型 有 效 
载荷 的 操纵 。 

连 杆 

工业 机 器 人 所 关注 的 重点 是 在 弯曲 和 扭转 时 的 连 
杆 刚度 。 为 了 提供 这 种 刚度 ， 机 器 人 的 连 杆 常设 计 成 
WE (FETE) 的 结构 。 单 体 结构 拥有 低 的 质量 
或 者 高 的 强度 - 质量 比 ， 但 是 更 加 昂贵 ， 也 较 难 制造 。 
和 铸造、 锻造 或 加 工 梁 的 连 杆 往往 具有 更 低 的 成 本 ， 见 
Juvinall 和 MarshekP^ 5! 和 Sigley 和 Mischke/^ 7: , 

另 一 个 重要 考虑 是 连 杆 结构 是 否 包 括 用 螺栓 、 焊 
接 或 粘 合 剂 连接 的 组 装 件 ， 包 括 铸 件 ， 机 械 加 工件 以 
及 制造 件 等 。 螺 钉 和 螺栓 连接 看 起 来 似乎 简单 ， 价 格 
低廉 ， 易 于 维护 ， 但 即使 在 制造 过 程 中 都 会 出 现 的 不 
可 避免 的 连 杆 变形 给 这 个 由 多 种 零件 组 装 而 成 的 装配 
件 引 入 了 塑性 变形 ， 这 些 变形 会 造成 机 器 人 尺寸 和 功 
能 的 变化 。 而 焊接 与 铸造 结构 对 于 塑性 变形 和 浪 后 形 
变 都 更 加 不 敏感 ， 虽 然 许多 情况 下 ， 它 们 还 要 二 级 加 
工 ， 如 去 除 热 应 力 和 精 加 工 。 

铸件 最 低 的 实际 壁 厚 或 网 格 厚度 可 能 会 大 于 保证 
刚度 所 需 的 厚度 。 薄 壁 可 以 通过 薄皮 结构 ( 单 体 结 
构 ) 来 实现 ， 但 是 这 种 优势 可 能 被 潜在 凹 痕 、 永 和 久 
变形 和 轻微 碰撞 的 损坏 所 抵消 。 因 此 ， 当 选择 机 器 人 
的 机 构 和 制造 细节 时 ， 必 须 考虑 性 能 要 求 。 

特种 实用 材料 和 几何 学 都 被 用 于 减少 连接 结构 的 
质量 ， 从 而 也 减少 了 与 之 直接 相关 的 重力 和 惯性 载 
位。 由 镁 或 铝 合 金 构成 的 横 截 面 恒定 的 冲压 件 对 于 实 
现 直线 运动 的 结构 来 说 非常 方便 。 对 于 要 求 高 加 速度 
的 机 器 人 《喷涂 机 器 人 ) ， 碳 和 玻璃 纤维 合成 物 使 其 
轻 量 化 。 热 塑性 塑料 提供 了 廉价 的 连 杆 结构 ， 虽 然 它 
的 负载 能 力 会 有 所 降低 。 不 锈 钢 经 常 被 用 于 提供 医疗 
和 饮食 服务 的 机 器 人 。 因 为 旋转 的 关节 产生 的 线 加 速 
随 着 其 与 轴 的 距离 的 增加 而 增加 ， 所 以 通过 设计 ， 常 
常 要 减 小 那些 与 这 种 关节 相连 的 连 杆 的 横断 面积 和 辟 
厚 ， 从 而 减少 相关 的 惯性 负载 。 
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3.6.2 关节 

对 大 多 数 机 器 人 而 言 ， 关 节 只 可 以 旋转 或 者 平 
移 ， 对 应 的 ， 这 两 种 关节 被 定义 为 旋转 关节 和 移动 关 
节 。 其 他 可 用 的 关节 有 球 槽 接合 的 或 者 球形 的 关节 ， 
还 有 胡 克 型 通用 关节 。 

包含 驱动 器 和 位 置 传感器 的 关节 结构 的 综合 机 械 
结构 是 结构 灵活 性 的 来 源 。 关 节 承 载 区域 的 变形 可 以 
减少 轴 和 齿轮 的 预 载荷 ， 允 许 间隙 和 空转 ， 也 就 减少 
了 精度 。 结 构 的 灵活 性 也 可 以 影响 齿轮 的 中 心 距 ， 引 
起 力 和 转 矩 ， 同 时 导致 相关 的 变形 ， 如 粘 合 、 堵 塞 以 
及 磨损 。 


3.7 关节 机 构 


一 个 机 器 人 关节 至 少 由 四 个 主要 部 分 构成 : 
关节 轴 、 驱 动 器 、 传 动 系统 以 及 状态 传感器 (GH 
常 作为 位 置 反馈 ， 但 是 速度 传感器 、 力 传感器 也 
是 常见 的 ) 。 

对 于 最 大 加 速度 小 于 0. 5 倍 重力 加 速度 的 低 性 能 
操作 器 ， 系 统 惯性 并 没有 重力 及 其 转 矩 重要 。 这 意味 
着 驱动 器 可 以 放置 在 关节 附近 ， 它 们 的 悬浮 质量 补偿 
了 平衡 质量 、 弹 力 和 气压 。 

对 于 最 大 加 速度 达到 甚至 超过 3 ~ 10 个 重力 加 速 
度 的 高 性 能 机 器 人 ， 惯 性 质量 的 最 小 化 就 非常 重要 
了 。 为 了 减 小 惯性 质量 ， 驱 动 器 被 放置 在 系列 操作 器 
的 第 一 个 关节 轴 附 近 ， 并 且 通 过 连 杆 、 带 、 强 索 或 者 
传动 装置 来 驱动 关节 。 

更 长 的 传动 距离 虽然 可 以 减少 质量 、 重 力 力矩 和 
惯性 ， 但 是 也 引入 了 挠 度 ， 从 而 降低 了 系统 的 刚度 。 
每 个 关节 的 驱动 器 位 置 和 传动 设计 与 重力 、 惯 性 、 刚 
度 和 复杂 性 是 两 组 此 消 披 长 的 矛盾 因素 ， 需 要 我 们 在 
其 中 做 出 折衷 的 选择 。 这 个 选择 就 决定 了 操作 器 的 主 
要 物理 特征 。 
举例 说 明 ， 例 如 Adept 1 综合 机 器 人 ， 其 有 四 个 
自由 度 ， 每 个 都 拥有 不 同 的 结构 。 第 一 个 轴 是 由 电 
动机 直接 驱动 ， 第 二 个 轴 由 传动 带 条 驱动 ， 第 三 个 
由 传动 带 驱动 ， 最 后 一 个 由 直线 型 的 滚珠 丝 杠 驱动 。 
关于 各 种 有 用 的 关节 操作 器 ， 请 参看 Sclater 和 Chi- 
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3.7.1 关节 轴 结 构 


1. 旋转 轴 
旋转 关节 是 被 设计 


] 来 实现 纯 旋转 。 评 价 一 个 旋 


转 关 节 最 重要 的 指标 是 它 的 刚度 或 者 说 是 抵抗 其 他 干 
扰 运 动 的 能 力 。 在 刚度 设计 中 所 应 考虑 的 关键 因素 有 
轴 的 直径 、 误 差 和 间 际 ,轴承 的 支撑 结构 ， 以 及 在 梁 
上 加 载 合适 的 预 载 荷 。 轴 的 直径 和 轴承 的 尺寸 不 总 是 
以 承载 能 力 为 基础 的 。 实 际 上 ， 它 们 经 常 依 据 刚 性 的 
支撑 结构 而 进行 选择 ， 并 且 他 们 还 需要 具有 一 个 足够 
大 的 可 以 保证 线 缆 穿 过 的 管道 ， 甚 至 一 个 其 他 单元 的 
控制 元 件 通 过 的 孔洞 。 因 为 关节 轴 经 常 传递 转 矩 ， 所 
以 它 和 它 的 支撑 结构 必须 被 设计 用 来 同时 承受 弯曲 和 
扭转 。PUMA 机 器 人 的 第 一 个 轴 就 是 一 个 有 大 直径 管 
状 构造 的 关节 的 例子 。 

选择 一 个 旋转 轴 的 支撑 结构 是 保证 刚度 的 一 个 
重要 因素 。 支 撑 托 架 的 排列 方式 和 构造 必须 把 制造 
的 偏差 、 热 膨胀 以 及 轴承 预 紧 力 考 虑 在 内 。 通 过 减 
少 轴承 径 向 和 轴 向 的 运动 ， 角 接触 轴承 或 圆锥 滚 子 
轴承 的 轴 向 预 紧 力 提 高 了 系统 精确 度 和 刚度 。 预 载 
荷 可 以 通过 选择 性 的 装配 、 弹 性 的 元 件 、 垫 片 、 垫 
圈 、 四 点 接触 轴承 、 双 联 式 轴承 排列 、 或 者 紧 配 合 
来 获得 。 

2. 移动 关节 

移动 关节 有 两 种 基本 类 型 : 单 级 型 和 伸缩 型 。 单 
级 型 关节 由 一 个 可 沿 另外 一 个 固定 表面 移动 的 表面 组 
成 。 伸 缩 型 关节 本 质 上 是 由 单 级 型 关节 徐 套 或 组 合成 
的 。 单 级 型 关节 具有 结构 简单 和 高 刚度 的 优点 ; qi fr 
缩 型 关节 的 主要 优点 是 它 的 连结 紧凑 ， 并 且 有 大 的 伸 
缩 比 。 对 于 一 些 动作 来 说 ， 伸 缩 型 关节 有 更 小 的 4 
性 ， 因 为 其 关节 的 某 些 部 分 可 能 没有 移动 或 者 以 减 小 
的 加 速度 移动 。 

移动 关节 中 轴承 的 主要 的 功能 是 促进 其 在 某 一 方 
向 上 的 移动 ， 同 时 防止 其 他 方向 的 运动 。 防 止 那些 我 
们 所 不 希望 的 移动 给 我 们 带 来 更 具 挑战 性 的 设计 问 
题 。 结 构 的 变形 对 轴承 表面 构造 影响 很 大 ， 而 轴承 表 
面 的 构造 又 影响 到 了 机 器 人 的 性 能 。 在 一 些 情 形 中 ， 
由 于 载荷 引起 的 圆 简 偏差 可 能 导致 会 妨碍 运动 的 阻 
塞 。 对 于 高 精度 的 移动 关节 ， 在 长 距离 下 也 要 保持 路 
径 的 直线 性 。 在 有 摩擦 的 多 重 表面 要 达到 要 求 的 精度 
是 十 分 昂贵 的 。 移 动 关节 的 轴承 和 路 径 都 需要 被 昂贵 
并 且 大 面积 的 护 电 所 覆盖 和 密封 。 

评价 大 量 的 (接近 或 者 就 在 腕 关节 或 末端 执行 
器 之 上 ) 线性 移动 关节 或 轴 的 主要 参数 是 刚度 -质量 
比值 。 获 得 一 个 好 的 强度 -质量 比 需要 使 用 空心 或 者 
薄 壁 结构 ， 而 不 是 实心 的 运动 元 件 。 

轴承 间距 在 刚度 设计 时 也 至 关 重 要 。 如 果 间 距 
太 短 ， 无 论 轴 承 的 刚度 多 高 ， 系 统 刚度 都 会 不 够 。 
移动 关节 失效 的 主要 原因 是 混和 人 了 杂质 以 及 表面 的 
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疲劳 磨损 ， 引 起 这 些 缺 陷 的 主要 原因 是 大 的 预 载荷 、 
力矩 载荷 以 及 冲击 载荷 在 滚动 体 上 产 成 了 过 大 的 
负载 。 

由 于 具有 大 面积 的 暴露 在 外 的 精密 表面 ， 大 多 数 
移动 关节 相对 于 转动 关节 而 言 对 于 不 合理 操作 和 环境 
因素 更 加 敏感 。 同 时 ， 移 动 关节 也 更 加 难于 制造 、 装 
配 和 校 直 。 
移动 关节 中 滑动 元 件 的 常见 类 型 主要 有 铜 或 热 塑 
性 套 管 。 这 些 套 管 有 成 本 低 、 相 对 的 高 承载 能 力 和 可 
在 未 硬化 或 微 硬化 表面 工作 等 优点 。 因 为 在 移动 元 件 
上 的 压力 被 分 散 了 ， 从 而 数值 较 小 ， 所 以 它 可 以 由 薄 
壁 套 管 来 做 成 。 另 外 一 种 常见 的 套 管 是 球状 套 管 。 相 
对 热塑性 套 管 来 说 ， 球 状 套 管 有 低 摩擦 和 高 精度 等 优 
点 。 然 而 ， 它 们 需要 接触 表面 被 热处理 过 或 热 硬化 过 
(通常 需要 达到 55Re 或 更 高 的 硬度 ) ， 而 且 需 要 足够 
的 厚度 和 框架 结构 ， 从 而 能 够 承载 由 球 的 点 接触 特性 
而 带 来 的 高 应 力 。 
球 和 深 珠 导轨 在 机 器 人 的 移动 关节 中 也 很 常见 。 
此 滑动 结构 包含 两 种 基本 类 型 : 循环 和 非 循 环 。 非 
循环 的 球 和 滚珠 导轨 主要 应 用 于 得 位 移 装置 上 。 它 
们 具有 高 精度 以 及 低 摩 擦 的 优点 ,但 男 一 方面 ,也 
因此 导致 其 对 冲击 敏感 ， 同 时 对 转 和 矩 负载 的 能 力 较 
差 。 相 对 来 说 ， 循 环球 和 滚珠 导轨 在 一 定 程度 上 没 
有 那么 精确 ， 但 是 能 承载 更 高 的 载荷 。 它 们 也 可 以 
被 用 来 承载 相对 较 大 的 载荷 ， 其 移动 区 间 也 可 以 有 
几米 之 长 。 商 业 用 的 可 循环 球 和 滚珠 导轨 已 经 大 大 
简化 了 直线 轴 的 设计 和 结构 ， 特 别 是 在 构架 和 轨道 
操纵 其 方面 。 

另外 一 种 常见 的 机 器 人 移动 关节 是 由 凸轮 附件 、 
滚筒 或 者 滚轮 组 成 的 ， 这 些 滚动 体 均 是 在 模压 、 拔 
模 、 机 加 工 或 者 麻 光 后 的 表面 上 进行 滚动 的 。 在 大 载 
荷 装置 中 ， 深 动 体 深 动 所 在 的 表面 必须 在 最 终 精 磨 之 
前 进行 硬化 处 理 。 凸 轮 附 件 在 购买 时 会 带 有 独特 的 安 
装 杆 ， 它 可 以 被 用 来 辅助 装配 和 调整 ， 而 弹性 套 管 可 
以 使 运行 更 安静 和 顺畅 。 

两 种 较 少 见 的 机 器 人 移动 关节 是 以 弯 板 轴承 和 空 
气 轴承 为 特点 的 。 使 用 弯 板 轴承 的 关节 的 运动 是 由 文 
撑 零 件 的 深 结 构 的 弹性 变形 提供 的 ， 因 此 ， 它 主要 应 
用 在 高 精度 、 准 线性 的 短 距 移动 上 。 空 气 轴承 需要 光 
滑 的 表面 ， 对 公差 的 近 距 离 控制 ， 以 及 将 经 过 过 滤 且 
无 油 的 压缩 气体 稳定 地 通信 其中。 两 个 或 者 三 个 自由 
度 的 空气 轴承 可 以 用 很 少 的 移动 结构 实现 多 轴 移 动 ， 
如 图 3. 12 所 示 。 

3. 关节 运动 
肩 部 、 肘 部 以 及 连接 件 的 旋转 关节 构 型 决定 了 机 


SE 


图 3. 12 Robotworld 是 一 款 具 有 多 空气 轴承 的 
完整 机 器 人 工作 单元 


械 臂 的 工作 范围 。 腕 部 关节 构 型 通常 决定 了 工件 在 其 
工作 范围 内 一 点 处 的 姿态 范围 〈 即 灵巧 工作 空间 ) 。 
当 需 要 机 械 臂 到 达 一 个 在 扩大 的 任务 空间 中 的 特定 位 
置 时 ， 则 关节 行程 空间 会 增 大 ， 进 而 将 会 增加 构 型 参 
数 的 范围 。 比 如 在 可 控 路 径 运 动 ， 同 步 运动 以 及 检测 
运动 中 , 在 360° ~720° 之 间 的 腕 部 运动 范围 将 能 较 
好 地 实现 功能 。 在 装配 旋转 机 械 或 者 拧 螺 纹 时 ， 连 续 
的 末端 关节 旋转 是 必需 的 。 

附加 关节 和 连接 件 虽 然 有 时 被 布置 在 机 器 人 本 体 
上 ， 但 更 多 情况 下 是 在 其 末端 执行 器 上 ， 这 些 关 节 和 
连 杆 是 也 能 够 增加 任务 空间 的 专用 工具 。 连 续 型 机 器 
人 和 可 控 路 径 机 器 人 的 运动 都 需要 考虑 能 够 避 开 奇异 
点 的 运动 设置 (奇异 点 即 是 指 有 两 个 或 更 多 关节 共 
线 或 者 接近 共 线 的 区 域 ) ， 以 及 因此 而 造成 的 末端 执 
行 器 的 不 稳定 运动 。 一 个 通过 精心 控制 以 及 工作 单元 
布局 的 设计 而 实现 的 执行 器 可 以 增加 有 效 工 作 空间 ， 
同时 利用 关键 路 径 设置 来 避 开 奇异 点 区 域 。 例 如 ， 一 
个 标准 的 三 轴 机 器 人 腕 部 有 两 个 互 成 180° 的 奇异 点 ， 
而 这 个 角度 可 以 通过 一 个 能 够 减少 奇异 点 的 更 加 复杂 
的 腕 部 设计 增加 到 360*。 这 样 的 腕 部 被 用 在 剪 羊毛 
的 机 器 人 上 ， 以 达到 复合 、 长 程 、 连 续 、 光 滑 、 常 速 
以 及 具有 传 感 天 反馈 的 设计 要 求 。 


3.7.2 驱动 器 


驱动 器 为 机 器 人 提供 动力 源 。 大 多 数 机 融 人 驱动 
器 来 源 于 市 场 上 现 有 的 组 件 ， 当 然 ， 在 用 于 具体 的 项 
目 时 会 做 出 修改 以 适应 要 求 。 三 种 最 常用 的 驱动 器 分 
别 为 液压 式 、 气 动 式 和 电磁 式 。 

1. 液压 式 驱动 器 

早期 的 工业 机 器 人 选用 的 是 液压 式 驱动 器 ， 因 
6 提供 非常 大 的 作用 力 ， 并 有 非常 可 观 的 功率 - 
上 。 在 液压 式 驱动 咒 中 ， 能 量 来 自 于 由 电动 机 
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或 者 发 动机 带动 的 高 压 流 体 泵 ， 见 图 3. 10。 驱 动 器 
通常 有 直线 气 氏 ,旋转 叶轮 以 及 液压 电动 机 三 种 。 
驱动 控制 是 通过 电磁 阀 以 及 一 个 由 低 功 率 的 控制 电 
路 控制 的 伺服 阀 的 开 闭 来 实现 的 。 液 压 式 驱动 器 需 
要 消耗 大 量 的 功率 ,同时 快速 反应 的 伺服 阀 成 本 也 
非常 高 。 漏 液 以 及 复杂 的 维护 也 限制 了 液压 驱动 机 
器 人 的 应 用 。 

2. 气动 式 驱动 器 

气动 式 驱 动 器 起初 只 应 用 在 简单 的 执行 装置 上 。 
通常 ， 它 们 能 在 机 械 极限 之 内 提供 无 级 运动 。 这 种 
驱动 需 在 点 到 点 的 运动 中 表现 尤为 出 色 。 它 们 简单 
易 用 且 成 本 低 。 尽 管 有 些小 型 驱动 器 可 以 在 工厂 原 
有 气 源 下 工作 ， 但 大 量 地 使 用 这 种 装置 需要 安装 晶 
贵 的 空气 压缩 系统 。 同 时 ,气动 式 驱动 右 的 能 效 比 
较 低 。 

均衡 式 闭 环 伺服 气动 控制 器 已 经 研制 成 功 ， 并 
主要 被 运用 在 一 些 由 于 安全 、 环 境 和 应 用 场所 导致 
电 驱 动 不 能 满足 设计 要 求 的 场合 。DeLaval Interna- 
tional AB Tumba 的 主动 式 挤 奶 系统 (Voluntary Mil- 
king System) 就 是 一 个 例子 。 其 中 使 用 的 是 具有 电 - 
气 混合 驱动 阀门 关节 控制 的 气动 式 驱 动 ( 见 图 
3.11), 

3. 电磁 式 驱动 

当今 最 常见 的 驱动 莫 过 于 电磁 式 驱 动 妖 了 。 

1) 步 进 电 动机 。 一 些 诸如 台式 胶水 分 配 机 器 人 
之 类 的 简单 的 小 型 机 器 人 通常 就 使 用 永 磁 混合 式 或 
是 可 变 磁 阻 式 的 步 进 和 脉冲 电动 机 ( 见 图 3.13)。 
这 种 机 器 人 使 用 开 环 的 位 置 及 速度 控制 。 它 们 的 成 
本 相对 比较 低 ， 并 且 与 电子 驱动 电路 的 接口 比较 容 
易 实现 。 微 步 进 控制 可 以 产生 10000 或 是 更 多 的 独 
立 的 机 絮 关 节 位 置 。 在 开 环 步 进 模式 下 ， 电 动机 以 
及 机 器 人 的 运动 有 很 显著 的 稳定 时 间 ， 而 这 种 现象 可 
以 通过 机 械 的 或 是 控制 算法 的 方式 进行 抑制 。 步 进 电 
动机 的 能 重 比比 其 他 类 型 的 电动 机 更 小 。 有 闭环 控制 
功能 的 步 进 电 动机 与 直流 或 交流 的 伺服 电动 机 相似 
( 见 图 3.14) 。 

2) AK WES A OL, KREI E i e A FL 
机 有 很 多 不 同 的 类 型 。 低 成 本 的 永 磁 电动 机 使 用 陶瓷 
( 铁 基 ) 人 磁铁。 玩具 机 器 人 和 非 专 业 机 器 人 便 常 常 应 
用 这 种 电动 机 。 敏 铁 硼 由 于 其 最 强 的 磁性 ， 在 同等 体 
积 下 往往 可 以 产生 最 大 的 转 矩 和 功率 。 

无 铁心 的 转子 式 电动 机 通常 用 在 小 机 器 人 上 ， 其 
RRA RARAHI FREF, 复合 杯 状 结构 
或 是 盘 状 转子 结构 。 这 种 电动 机 有 很 多 优点 ， 比 如 电 
感 系数 很 低 ， 摩 擦 很 小 ， 且 没有 购 齿 转 矩 。 圆 盘 电 枢 


c 


en 


图 3.14 Adept 机 器 人 使 用 闭环 控制 和 
可 变 磁 阻 电动 机 


式 电动 机 也 有 如 下 优点 ， 比 如 它们 的 总 体 尺寸 较 小 。 
同时 ， 由 于 有 很 多 换 向 节 ， 其 可 以 产生 具有 低 转 矩 的 
平稳 输出 。 无 铁心 电 枢 式 电动 机 的 缺点 在 于 热 容量 很 
低 ， 因 为 其 质量 小 同时 传 热 的 通道 受到 了 限制 。 所 
以 ， 在 高 功率 工作 负荷 下 ， 它 们 有 严格 的 工作 循环 间 
隙 限制 以 及 被 动 空气 散热 需求 。 

3) 无 刷 电动 机 。 无 刷 电动 机 ， 也 分 交流 伺服 电 
动机 或 是 无 刷 直 流 电动 机 ， 通 常 是 应 用 在 工业 机 器 人 
E ( 见 图 3.15 及 图 3.16)。 这 种 电动 机 使 用 光学 的 
或 者 磁场 的 传感器 以 及 电子 换 向 电路 来 代替 石墨 电 刷 
以 及 铜 条 式 换 向 器 ， 因 此 可 以 减 小 摩擦 、 瞬 间 放 电 以 
及 换 向 器 的 磨损 。 无 刷 电动 机 在 低 成 本 的 条 件 下 表现 
突出 ， 主 要 归功 于 其 降低 了 电动 机 的 复杂 性 。 但 是 ， 
其 使 用 的 电动 机 的 控制 器 要 比 有 刷 电动 机 的 控制 器 更 
复杂 ， 成 本 也 要 更 高 。 无 刷 电动 机 的 被 动 式 多 磁极 铭 
磁铁 转子 以 及 铁 制 绕 线 定子 聚 有 良好 的 散热 性 和 可 靠 
性 。 线 性 无 刷 电动 机 的 功用 与 铺展 开 的 回转 马达 相 
似 。 它 们 通常 有 一 个 又 长 又 重 的 被 动 式 多 磁极 定子 和 
又 短 又 轻 的 电子 换 向 式 绕 线 滑 块 。 
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图 3.15 Baldor 直流 伺服 电动 机 
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图 3.16 Anorad 无 刷 电动 机 


4. 其 他 驱动 器 

各 种 其 他 类 型 的 驱动 器 也 已 应 用 于 机 器 人 。 其 中 
一 个 范例 包括 应 用 了 热学 、 形 状 记忆 合金 (SMA) 、 
金属 、 化 学 、 压 电 、 磁 致 伸缩 、 电 聚合 物 (EPAM), 
弹性 容器 和 微机 电 系 统 (MEMS) 的 驱动 器 (ILEI 
3.17 和 图 3. 18 ) 。 大 多 数 这 些 驱 动 器 已 应 用 于 研究 具 
有 特殊 应 用 的 机 器 人 ， 而 不 是 大 量 生产 的 工业 机 器 
人 。 压 电 陶 次 驱动 的 机 器 人 的 一 个 例子 是 PI 的 压 电 
式 六 足 亚 纳米 分 辩 率 平台 系统 ( 见 图 3.19) 。 


EON 


人 工 肌肉 EPAM 电动 机 
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图 3.18 Elliptec 压 电 电动 机 


图 3.19 FI 的 压 电 式 六 足 亚 纳米 分 辩 率 平台 系统 


3.7.3 变速 器 


传动 器 或 传动 系统 的 目的 是 将 机 械 动力 从 来 源 转 
移 到 受 载 荷 处 。 设 计 和 选择 一 个 机 器 人 传动 机 构 时 ， 
需要 考虑 机 械 装置 的 运动 ， 负 和 载 和 电源 的 要 求 ， 以 及 
相对 于 关节 的 驱动 器 放置 位 置 。 在 传动 器 设计 中 ， 首 
先 要 考虑 的 是 传动 器 的 刚度 、 效 率 和 成 本 。 齿 隙 和 扭 
转 都 会 影响 到 驱动 器 刚度 ， 尤 其 是 当 机 器 人 应 用 在 具 
有 连续 扭转 和 载荷 剧烈 变化 的 场合 中 。 高 传动 刚度 和 
NTA Bero FCT BS SEHR E EE ERIS, IER 
BLAS A fea EU TAPER De, A R 
好 的 效率 ， 但 在 低 载 荷 时 便 不 一 定 了 。 过 大 的 传动 系 
统 会 增加 系统 的 重量 、 惯 性 和 摩擦 损失 。 不 良 传动 系 
统 设计 会 有 较 低 的 刚度 ， 在 持续 的 或 是 高 负荷 的 工作 
循环 下 快速 磨损 ， 或 者 在 偶然 的 过 载 下 失效 。 

机 器 人 的 关节 驱动 基本 上 是 由 传动 装置 来 实现 
的 ， 它 以 一 种 高 能 效 的 方式 通过 关节 将 驱动 器 和 机 器 
人 连 杆 结合 起 来 。 各 种 各 样 的 传动 系统 形式 都 被 实际 
机 器 人 所 应 用 。 传 动机 构 的 传动 比 决定 了 驱动 器 到 连 
杆 的 转 矩 、 速 度 和 惯性 之 间 的 关系 。 传 动 系统 合理 的 
布置 ， 尺 才 以 及 机 构 设 计 决 定 了 机 器 人 的 刚度 、 质 量 
和 整体 操作 性 能 。 大 多 数 现 代 机 器 人 都 应 用 了 高 效 
的 、 抗 过 载 破坏 的 、 可 反 向 的 传动 装置 。 

1. 直接 驱动 
直接 驱动 是 运动 学 中 最 简单 的 驱动 机 制 。 对 于 气 
动 或 液压 驱动 的 机 器 人 ， 驱 动 器 直接 连接 在 连 杆 之 
间 。 直 接 驱 动 的 电动 机 器 人 采用 了 高 转 和 矩 、 低 速 的 电 
动机 直接 连接 到 连 杆 。 直 接 驱动 是 以 完全 去 除了 空 行 
程 和 平稳 转 矩 传动 系统 为 特点 的 。 但 是 ， 原 动 件 和 连 
杆 间 的 不 良 动态 匹配 (惯性 比例 ) 使 这 种 传动 方式 ) 
需要 一 个 更 大 的 、 能 源 效益 较 低 的 驱动 器 。 

2. 带 传动 器 
直接 驱动 的 一 个 变形 是 带 驱动 。 薄 合金 钢 或 钛 制 
履带 被 固定 在 驱动 器 轴 和 被 驱动 的 连 杆 之 间 ， 用 来 产 
生 有 限 的 旋转 或 直线 运动 。 传 动 装置 的 传动 比 可 以 高 
达 10:1 (驱动 需 转 10 圈 ， 节 点 转 1 圈 )。 驱 动 器 质 
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量 也 从 节点 处 移 开 了 一 一 通常 移 至 基 座 处 ， 以 减少 机 
器 人 惯性 和 重力 负荷 。 它 相 比 缆绳 或 皮带 传动 而 言 ， 
是 一 种 更 柔顺 并 且 刚性 更 好 的 传动 系统 。 

3. 皮带 传动 器 

同步 (QU) 皮带 往往 应 用 于 较 小 的 机 器 人 的 传动 
机 构 和 一 些 大 机 器 人 的 轴 上 。 其 功能 大 致 和 带 传动 相 
同 ， 但 具有 连续 驱动 的 能 力 。 多 级 (两 个 或 三 个 ) E 
带 传动 有 时 会 被 用 来 生产 大 的 传动 比 (高 达 100: 1)。 
张 紧 力 被 惰 轮 或 轴 距 的 调整 所 控制 。 长 皮带 的 弹性 和 
质量 可 能 导致 驱动 不 稳定 ， 从 而 增加 机 器 人 的 稳定 
时 间 。 

4. 齿轮 传动 
直 具 § 轮 或 斜 具 轮 传动 为 机 器 人 提供 了 可 靠 的 、 密 
封 的 、 低 维护 成 本 的 动力 传递 。 它 们 应 用 于 机 器 人 手 
脏 ， 在 这 些 手 腕 结构 中 多 个 轴线 的 相交 和 驱动 器 的 紧 
凑 型 布置 是 必需 的 。 大 直径 的 转盘 齿轮 用 于 大 型 机 器 
人 的 基 座 关节 ， 用 以 提供 高 的 刚度 来 传递 高 转 矩 。 齿 
轮 传动 常用 于 台 座 ， 而 且 往 往 与 长 传动 轴 联 合 ， 实 现 
了 驱动 器 和 驱动 关节 之 间 的 长 距离 动力 传输 。 例 如 ， 
驱动 器 和 第 一 减速 器 可 能 被 安装 在 肘 部 的 附近 ， 通 过 
一 个 长 的 空心 传动 轴 来 驱动 男 一 级 布置 在 腕 部 的 减速 
器 或 差 速 器 ( 见 图 3.1)。 

行星 齿轮 传动 常常 被 应 用 在 紧凑 的 齿轮 马达 中 
( 见 图 3.20) 。 为 了 尽量 减少 节点 齿轮 驱动 的 齿 院 游 
B ( 空 程 )， 具 轮 传动 系统 需要 具有 仔细 的 设计 、 高 


的 精度 和 刚性 的 支撑 ， 用 来 产生 一 个 不 以 牺牲 刚度 、 
效率 和 精度 来 实现 小 时 际 的 传动 机 构 。 机 絮 人 的 齿 际 
游 移 被 一 些 方法 所 控制 ， 包 括 选择 性 装配 、 齿 轮 中 心 
调整 和 专门 防 游 移 的 设计 。 

"x m 


图 3.20 航天 飞机 的 机 械 臂 具有 行星 齿轮 驱动 器 


5. 蜗轮 传动 
蜗轮 蜗杆 传动 偶尔 会 被 应 用 于 低速 机 器 人 。 他 们 
的 特点 是 可 以 使 动力 正 交 的 偏转 或 者 平移 ， 同 时 具 


高 的 传动 比 ， 机 构 简 单 ， 以 及 具有 良好 的 刚度 和 承载 
能 力 。 男 一 方面 ， 他 们 的 低 效率 使 他 们 在 大 传动 比 时 
具有 反问 自 锁 特性 。 这 使 得 在 没有 动力 时 ， 关 节 会 
锁 在 它们 的 位 置 ， 但 另 一 方面 ， 这 也 使 它们 容易 在 试 
图 手动 改变 机 器 人 位 置 的 过 程 中 被 损坏 。 

6. 专用 传动 装置 

专用 传动 装置 被 广泛 应 用 于 标准 工业 机 器 人 。 谐 
波 传动 和 旋转 矢量 (RV) 传动 器 就 是 两 个 例子 ， 它 
们 具有 紧凑 、 低 齿 隙 滑 移 、 高 转 矩 传递 能 力 等 特点 ， 
同时 ， 其 使 用 了 特殊 齿轮 、 凸 轮 和 轴承 (DLE 3.21 
和 图 3. 22)。 


图 3.21 谐 波 传动 


图 3.22  Nabtesco 旋转 矢量 传动 器 


谐 波 传动 器 常用 在 中 小 型 机 器 人 上 。 这 些 传动 需 
具有 较 低 的 齿 院 滑 移 ， 但 柔 轮 齿 圈 在 反 转 运动 时 会 导 
致 弹性 锤 曲 和 低 的 刚度 。 旋 转 矢量 传 动 器 通常 被 应 用 
于 大 型 的 机 器 人 ， 特 别 是 受 超载 和 冲击 负荷 的 那些 机 
AFA o 

7. 线性 传动 器 
直接 驱动 的 线性 传动 噩 合并 了 直线 电动 机 与 一 个 
直线 轴 。 这 种 联系 往往 只 是 驱动 器 和 机 器 人 连 杆 之 间 
的 一 个 刚性 或 柔性 连接 。 另 外 ， 一 个 由 直线 电动 机 和 
其 导轨 组 成 的 总 成 被 直接 连接 到 线性 轴 上 。 直 接线 性 
电磁 驱动 器 的 特点 是 : 零 齿 隙 滑 移 ， 高 刚度 ， 高 的 速 
度 和 优良 的 性 能 ， 但 是 其 质量 也 较 大 ， 效 率 低 ， 成 本 
比 其 他 类 型 的 线性 驱动 器 更 高 。 

8. 滚珠 丝 杠 

滚珠 丝 杠 的 线性 传动 器 有 效 和 平顺 地 将 原 动 件 


m 


6) 
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旋转 运动 变 成 直线 运动 。 通 常情 况 下 ， 循 环球 螺母 通 
过 与 平面 和 硬化 合金 钢丝 杠 的 配合 来 将 旋转 和 运动 转 
换 成 直线 运动 。 滚 珠 丝 杠 可 以 很 容易 地 与 线性 轴 匹 
配 。 紧 凑 型 驱动 器 /传动 系统 总 成 ， 以 及 其 为 了 客户 
组 装 而 设计 的 零件 都 已 经 实现 。 刚 度 对 短 距 的 和 中 
距 的 行程 比较 好 ,但 由 于 丝 杠 只 能 在 两 端 被 制 成 ， 
所 以 它 在 长 行程 中 的 刚度 并 不 好 。 通 过 精确 的 丝 杠 
可 以 获得 很 低 或 为 零 的 齿 险 。 运 行 速度 被 丝 杠 的 力 
学 稳定 性 所 制约 ， 所 以 采用 旋转 螺母 的 方式 可 以 获 
得 更 高 的 速度 。 低 成 本 机 器 人 可 使 用 普通 丝 杠 传动 
装置 ， 它 的 特点 是 在 光滑 的 轧 制 丝 枉 上 采用 有 热 塑 
性 塑料 的 螺母 。 

9. 齿 条 和 人 齿轮 传动 系 

这 些 传统 的 传动 部 分 在 直线 ， 甚 至 弯曲 的 导轨 上 
对 长 距离 运动 是 有 益 的 。 刚 度 是 由 齿轮 / 齿 条 连接 处 
和 独立 行程 长 度 决 定 的 。 齿 隙 滑 移 可 能 难以 控制 ， 因 
为 在 整个 行程 长 度 中 控制 具 条 到 齿轮 中 心 的 公差 。 双 
齿轮 驱动 有 时 被 用 来 供 主动 的 预 紧 力 ， 从 而 消除 齿 际 
滑 移 。 由 于 较 低 的 传动 比 ， 有 效力 普遍 低 于 丝 杠 传动 
Ro DAR 〈 低 齿 数 ) 齿轮 的 重合 度 较 低 ， 因 而 易 
造成 振动 。 渐 开 线 齿 面 齿轮 需要 润滑 油 来 减少 磨损 。 
这 些 列 出 的 台式 传动 系统 经 常 被 应 用 于 大 型 龙门 式 机 
项 人 和 轨道 式 机 器 人 【〈 见 图 3.23) 。 


交叉 件 


Ao SB an 


3 轴 腕 部 


图 3.23 NASA 龙门 式 机 器 人 


10. 其 他 传动 系统 组 件 

一 些 其 他 机 械 部 件 的 例子 ， 如 花 键 轴 ， 运 动 间 的 
连接 件 (VUE, HAAR DLS), HER, REER 
iat, Arar, a, WRI, CATAR 
于 机 器 人 传动 系统 中 ( 见 图 3.8), Yaskawa Robot- 
World 的 装配 和 过 程 自动 化 机 器 人 是 由 磁力 所 悬 置 ， 
在 一 个 两 自由 度 的 平面 空气 轴承 上 移动 ， 同 时 采用 直 
接 驱 动 平面 电磁 马达 ， 并且 内 部 没有 运动 部 件 (UU 
图 3.12)。 


3.8 机 器 人 的 性 能 


工业 机 器 人 的 性 能 往往 用 功能 运行 情况 和 循环 时 
间 来 体现 。 对 装配 机 器 人 来 说 ， 这 种 评价 标准 往往 是 
依据 每 分 钟 所 完成 的 取 放 循 环 次 数 。 弧 焊 机 器 人 往往 
被 设 定 了 一 个 缓慢 的 焊接 模式 和 摆动 速度 ， 以 及 一 个 
快 的 再 定位 速度 。 对 于 涂 装 机 器 人 ， 附 着 或 覆盖 的 比 
率 和 喷雾 模式 下 的 速度 是 很 重要 的 。 机 器 人 的 峰值 速 
度 和 加 速度 列表 数据 一 般 只 是 计算 量 ， 由 于 在 机 器 人 
移动 过 程 中 产生 的 外 形 的 变化 而 带 来 了 动态 的 〈 惯 
性 ) 和 静态 的 〈 重 力 ) 耦合 ， 因 而 其 峰值 加 速度 和 
速度 会 在 工作 过 程 中 有 所 变化 。 
3.8.1 机 器 人 速度 

最 大 的 关节 速度 (角速度 或 线 速度 ) 并 不 是 一 
个 独立 的 值 。 对 于 更 长 距离 的 运动 ， 它 往往 被 伺服 电 
动机 的 总 线 电 压 或 最 大 人 允许 的 电动 机 转速 所 限制 。 对 
于 大 加 速度 机 器 人 ， 甚 至 短 的 点 对 点 的 运动 也 可 能 
速度 限制 。 对 于 低 加 速 机 器 人 ， 仅 仅 总 体 的 运动 有 速 
度 限 制 。 对 于 大 型 机 器 人 ， 典 型 的 末端 执行 器 峰值 束 
度 可 高 达 20m/s。 


3.8.2 机 器 人 加 速度 


在 大 多 数 现代 的 机 械 手 中 ， 因 为 和 机 械 臂 的 质量 
相 比 ， 有 效 载荷 的 质量 较 小 ， 因 而 更 多 的 动力 是 被 用 
于 加 速 机 器 人 而 不 是 其 负载 。 加 速度 既 影 响 总 体 运动 
时 间 ， 也 影响 运行 周期 时 间 ( 总体 运 动 时 间 加 稳定 
时 间 ) 。 能 够 承受 更 大 加 速度 的 机 械 臂 往往 是 刚性 更 
好 的 机 械 臂 。 在 高 性 能 机 械 辟 上， 比 起 速度 或 负载 能 
力 来 说 ， 加 速 和 稳定 时 间 是 更 重要 的 设计 参数 。 对 于 
一 些 装 配 和 物料 装 御 的 机 器 人 而 言 ， 其 最 大 加 速度 比 
小 有 效 载荷 超过 了 10g。 


3.8.3 重复 性 


这 个 参量 代表 了 执行 器 多 次 返回 到 同一 个 位 置 的 
能 力 。 由 于 不 同 的 执行 器 运行 程序 设计 的 影响 ， 大 多 
数 制造 商 更 倾向 于 以 一 个 他 们 自己 定义 的 参量 来 评价 
重复 性 。 这 个 参量 是 指 ， 从 同样 的 初始 位 置 开 始 ， 采 
用 同样 的 程序 ， 载 位 和 安装 设 定 ， 机 械 辟 能够 回 到 初 
始 位 置 时 的 有 效 运行 球 形 空间 的 半径 。 这 一 空间 可 能 
不 包括 的 目标 点 ， 因 为 计算 误差 、 简 化 的 校正 、 精 度 
的 限制 、 示 教 和 执行 模式 的 不 同 可 能 会 比 摩擦 、 未 解 
除 的 关节 和 传动 系 空 程 、 伺 服 系统 增益 以 及 结构 和 机 
械 装配 过 程 中 的 空 际 导 致 更 大 的 误差 。 设 计 者 必须 认 
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真 考虑 所 需 的 重复 性 评价 参量 。 当 进行 重复 的 工作 ， 
如 盲 装配 或 机 器 载 人 时 ， 重 复 性 便 非 常 重要 。 典 型 重 
复 性 参数 的 范围 从 对 于 大 型 电焊 机 器 人 的 1 ~ 2mm 到 
对 于 精确 机 器 人 的 0. 005mm (5pm)。 
分 辩 率 

这 个 参数 代表 的 是 能 够 由 执行 器 完成 的 最 小 增 
上 距离。 在 传感器 控制 的 机 器 人 运 劲 和 精确 定位 中 ， 
辩 率 是 很 重要 的 。 尽 管 大 多 数 制造 商 依据 关节 位 置 
码 器 的 分 辨 率 ， 或 伺服 电动 机 和 传动 装置 的 步 长 来 计 
算 系 统 的 分 辨 率 ， 但 这 是 一 种 误导 ， 因 为 系统 摩擦 、 
扭曲 、 齿 际 游 移 和 运动 的 配置 都 影响 着 系统 分 辨 率 。 
典型 的 编码 器 或 解析 器 的 分 辩 率 是 全 轴 或 节点 行程 的 
10% ~10” 分 之 一 , 但 实际 物理 分 辩 率 可 能 是 介 于 
0.001 ~0.5mm。 多 节点 串联 连接 机 械 臂 的 有 效 分 辩 
率 不 如 其 单个 关节 。 


3.8.5 精度 


这 个 参数 代表 的 是 机 器 人 在 空间 内 ， 将 其 执行 装 
置 定位 到 程序 设 定位 置 的 能 力 。 机 器 人 的 准确 性 对 于 
非 重 复 型 的 任务 非常 重要 ， 这 些 任 务 既 可 能 被 数据 库 
中 的 程序 所 设 定 ， 也 可 以 是 一 种 在 安装 时 已 经 预 设 好 
的 ， 对 于 可 控 的 变化 进行 处 理 的 “ 示 教 任务 "”。 精 度 
是 一 个 手臂 关于 运动 学 模型 精确 度 (节点 类 型 、 连 
杆 长 度 、 关 节 之 间 的 角度 ， 以 及 所 有 对 于 连 杆 或 节点 
在 负载 下 挠 度 的 核算 等 ) ， 空 间 、 工 具 、 夹 具 模 型 的 
精度 ， 以 及 机 械 臂 方案 解决 路 径 的 完整 性 和 准确 性 的 
函数 。 虽 然 大 多 数 更 高 级 的 机 器 人 编程 语言 支持 机 械 
臂 解 决 方案 ， 这 些 解决 方案 通常 只 是 建立 在 简化 的 刚 
性 结构 模型 的 基础 上 。 因 此 ， 机 器 人 精度 便 成 为 了 一 
个 匹配 机 器 人 几何 学 特性 和 机 器 人 解决 方案 的 问题 ， 
其 中 ,我们 需要 精确 地 测量 和 校准 连 杆 长 度 、 关 节 角 
度 和 安装 位 置 。 

典型 的 工业 机 器 人 精度 范围 从 具有 低级 计算 机 模 
型 的 非 标定 执行 器 的 +10mm， 到 精确 的 机 械 工 具 执 
tral x0. 01mm， 此 执行 器 包含 了 具有 精确 动态 模 
型 和 解决 方案 的 控制 器 、 精 准 的 制造 工艺 ， 以 及 动态 
测量 元 件 。 


3.8.6 组 件 寿命 与 占 空 比 


一 个 电动 机 器 人 中 ， 有 最 大 的 失败 问题 的 三 个 组 
件 是 驱动 器 (伺服 电动 机 ) 、 传 动 装置 以 及 电源 和 信 
号 电线。 平均 故 障 间 隔 时 间 (MTBF) 应 至 少 在 
2000h， 而 最 好 在 主要 部 件 所 计划 的 保养 维护 之 间 至 
DAF 5000 个 运行 h。 


3.8.4 


at >> fl 


最 坏 情况 下 的 运动 周期 被 假定 为 用 最 新 机 器 人 装 
置 完 成 一 般 性 的 重复 任务 。 装 配 机 器 人 的 小 行程 设计 
循环 寿命 (小 于 5% 的 关节 行程 范围 ) 应 该 达到 
20 ~ 100 万 次 完整 的 双向 循环 。 大 行程 循环 寿命 CK 
F 50% 的 关节 最 大 行程 范围 ) 应 通常 是 5 ~40 万 次 。 
短期 的 满 负 蓓 工作 往往 被 传动 系统 的 最 大 载荷 所 
1; 而 长 期 、 持 续 的 工作 性 能 则 被 电动 机 发 热 所 限 
制 。 对 于 某 一 个 期 望 的 占 空 比 进行 设计 ， 而 不 是 平等 
程度 的 同时 追求 短期 和 长 期 性 能 ， 可 以 节约 成 本 和 改 
性 能 。 这 种 方案 允许 我 们 使 用 更 小 、 惯 性 更 低 、 质 
量 更 轻 的 电动 机 。 工 业 机 器 人 通常 在 达到 设计 循环 寿 
命 之 前 就 已 经 因为 过 时 而 被 蔡 换 。 


3.8.7 碰撞 


在 工作 中 ， 意 外 或 突 发 情况 可 能 偶尔 会 产生 碰 
撞 ， 涉 及 机 械 臂 及 其 工具 、 工 件 或 工作 空间 内 的 其 他 
物体 。 这 些 事故 可 能 会 导致 各 种 程度 的 破坏 ， 其 破坏 
的 程度 在 很 大 一 部 分 取决 于 机 械 臂 的 设计 。 如 果 在 这 
类 事故 中 的 时 间 成 本 和 费用 损失 很 大 ， 那 么 抵抗 碰撞 
的 设计 方案 就 应 在 设计 过 程 中 尽早 考虑 。 由 事故 造成 
的 典型 损害 包括 齿轮 或 轴 的 折断 或 剪 切 失效 ， 连 杆 结 
FARE, MCAT oh AR ol, LZR. We 
强 或 者 软 管 的 断裂 ， 严 重 磨损 或 变形 ， 以 及 连接 器 ， 
配件 ， 限 位 天 或 开关 的 损坏 。 和 柔性 的 原件 ， 如 超载 
(滑动 ) 离合 器 ， 弹 性 元 件 和 带 软 垫 的 表面 可 以 被 用 
来 减少 发 生 碰 撞 的 冲击 负荷 ， 从 而 帮助 解 耦 或 这 在 这 
类 碰撞 中 隔离 驱动 器 和 传动 系统 。 
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3.9 结论 与 扩展 阅读 
机 器 人 的 机 械 设 计 是 一 个 反复 的 过 程 ， 涉 及 工 
程 、 技 术 和 应 用 的 具体 因素 的 评价 和 选择 。 最 后 的 
设计 方案 应 反映 出 对 于 设计 任务 的 详细 要 求 的 仔细 
考虑 ， 而 不 是 仅仅 的 广义 规范 。 对 于 这 些 设计 要 求 
的 正确 的 定义 和 理解 是 实现 设计 目标 的 一 个 关键 
因素 。 

设计 和 选择 具体 的 组 成 部 分 涉及 权衡 的 考虑 。 纯 
静态 的 ， 刚 体 机 器 人 的 设计 是 经 常 被 应 用 的 ， 但 其 并 
不 总 是 充分 的 。 机 械 系统 的 刚度 、 固 有 频率 、 控 制 系 
统 的 兼容 性 ， 以 及 期 望 的 机 器 人 应 用 和 安装 要 求 都 必 
须 加 以 考虑 。 

关于 构成 机 器 人 系统 核心 的 机 构 和 原 动 件 设计 还 
有 许多 其 他 文献 。 其 中 一 个 著名 并 且 正 在 使 用 的 机 器 
人 设计 参考 资料 是 Rivin [3.44], 

Craig^ 5 Al Tsai ^ 提供 了 机 器 人 的 机 械 结构 与 
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其 工作 空间 和 机 械 增益 的 数学 关系 。Sclater 和 Chiro- 


nis 


3. 


是 对 于 多 种 有 效 的 应 用 装置 的 宝贵 汇编 的 一 


次 再 版 ， 比 如 关节 传动 系统 和 传动 装置 。McCart- 
ney 包括 了 设计 特定 机 构 的 几何 技术 。 


Juvinall 和 Marshek ^ 9^, [DJ & Shigley 和 Mish- 


ke? “是 关于 像 连 杆 结构 、 轴 承 ， 以 及 传动 系统 这 


样 结 


构 的 设计 的 重要 参考 资料 ， 而 这 些 都 对 机 器 人 系 


统 的 机 械 性 能 效率 起 到 了 至 关 重 要 的 作用 。 


和 公 


虽然 许多 设计 决策 可 以 通过 应 用 简单 直接 的 算法 
式 获得 ， 但 是 许多 其 他 重要 的 因素 使 得 机 絮 人 设 


计 成 为 了 一 个 需要 良好 的 工程 判断 力 的 挑战 。 
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第 4 曹 传 感 与 估计 


Henrik I. Christensen, Gregory D. Hager 


伍 小 军 译 

传 感 与 估计 是 任何 机 器 人 系统 设计 的 核心 。 在 4.2 传感器 ate ne ee oa a 73 
底层 ， 反馈 控制 必须 要 估计 机 器 人 自身 的 状态 。 在 4.3 全 全 人 76 
高 层 ， 传 感 ， 此 处 定义 为 以 任务 为 导向 的 传感器 数 4.3.1 点 估计 ee F7 
据 解释 ， 可 以 在 空间 和 时 间 领 域 融合 传感器 信息 来 4.3.2 其 他 估计 方法 和 pp 79 
促进 规划 。 4.83.8 BARI E cr ec ec ee cece cence eee e eee eens 80 
本 音 概述 了 在 机 器 人 领域 / 泛 应 用 的 常见 传 感 4.3.4 数据 关联 技术 CR A 82 

和 估计 方法 。 本 瘟 内 容 按照 过 程 模型 来 组 织 ， 包 括 4.3.5 ”传感器 模拟 84 
传 感 ， 特 征 提取 ， 数 据 关 联 ， 参 数 估计 和 模型 束 4.3.6 其 他 不 确定 性 管理 方法 和 84 
合 。 本 音 介 绍 和 描述 了 几 种 党 用 的 传 感 模式 的 特 44 ”表示 方法 ………………… PROIN IS 85 
征 ， 并 讨论 线性 和 非 线性 系统 中 常见 的 估计 方法 ， 4.4.1. BUGFOESSERAE cemere 85 
包括 统计 学 估计 、 凯 尔 曼 滤波 和 采样 法 。 本 章 也 简 人 85 
单 介 绍 了 和 鲁 棒 估计 的 策略 。 最 后 介绍 几 种 常用 的 估 4.4.3 离散 特征 表示 eA A MM 86 
HERE, 4.4.4 符号 /基于 图 的 模型 pp 86 
4.5 结论 与 扩展 阅读 站 pe 86 

参考 文献 sak uds Dues A da 87 


如 果 有 一 个 完整 的 环境 模型 ， 并 且 机 器 人 促 动 
器 能 够 相对 于 该 模型 完美 地 执行 运动 指令 ， ABA TS 
制 机 器 人 系统 将 变 得 相对 简单 。 很 遗憾 的 是 ， 大 多 
数 时 候 完 整 的 环境 模型 并 不 具备 ， 机 械 构 造 的 理想 
控制 也 从 来 都 不 现实 。 在 这 种 情况 下 ， 传 感 和 估计 


性 能 操作 和 医疗 介入 ， 对 于 一 个 给 定 的 系统 ， 适 合 的 
传 感 和 估计 很 明显 高 度 依赖 于 系统 的 任务 。 因 此 ， 此 
处 的 讨论 按照 以 任务 为 导向 的 外 部 世界 传 感 和 估计 来 
组 织 。 


传 感 和 估计 可 被 视 为 一 个 将 物理 数量 转换 为 可 用 


方法 被 用 来 弥补 完整 信息 的 缺失 。 它 们 的 功能 就 是 
提供 环境 和 机 器 人 系统 的 状态 信息 ， 作 为 控制 ， 决 
策 以 及 与 环境 中 其 他 单元 (例如 人 ) 进行 交互 的 
基础 。 

为 便于 讨论 ， 我 们 区 分 用 于 还 原 机 器 人 自身 状 
态 的 传 感 和 估计 为 “本 体感 受 ”， 并 区 分 用 于 还 原 
外 部 世界 状态 的 传 感 和 估计 为 “外 感受 ”。 在 实际 
应 用 中 ， 绝 大 多 数 机 器 人 系统 设计 有 本 体感 受 来 佑 
计 和 控制 自身 的 物理 状态 。 另 一 方面 ， 通 过 传感器 
数据 来 还 原 外 部 环境 状态 通常 是 一 个 更 广泛 也 更 复 
杂 的 问题 。 

早期 的 机 器 人 计算 感知 研究 假定 我 们 可 以 复原 出 
一 个 完整 通用 的 环境 模型 ， 并 用 它 来 进行 决策 和 了 驱 
动 ， 参 见 参 考 文献 [4.1] 中 的 范例 。 最近， 该 方法 
已 经 很 明显 地 不 切实 际 了 。 事 实 上 ， 考 虑 到 基于 传 感 
器 的 机 器 人 已 经 出 现在 各 种 领域 ， 例 如 移动 监控 、 高 


于 进一步 处 理 的 计算 机 表达 的 过 程 。 因 此 传 感 与 将 物 
理 存在 转换 为 可 被 计算 机 处 理 的 信号 的 转换 器 紧密 关 
联 。 传 感 也 与 感知 ， 即 在 以 任务 为 导向 的 环境 模型 中 
表征 传感器 信息 这 一 过 程 ， 密 切 相 关 。 然 而 ， 传 感 需 
数据 通常 以 不 同 的 方式 损坏 ， 导 致 该 过 程 更 加 复杂 。 
举例 而 言 ， 转 换 器 环节 产生 统计 学 噪声 ， 数 字 化 过 程 
中 引入 离散 化 ， 传 感 器 选择 不 良 引 入 模糊 量 等 。 因 此 
引入 估计 方法 来 支持 将 信息 恰当 地 融合 进 环境 模型 ， 
并 提高 信 噪 比 。 

本 章 介绍 传 感 与 估计 的 通用 特征 ， 而 本 手册 的 第 
3 篇 提供 了 部 分 更 深入 的 主题 内 容 。 本 章 4. 1 节 介 绍 
传 感 /估计 的 总 体 过 程 。4. 2 节 介 绍 不 同 种 类 的 传 感 
器 以 及 它们 的 关键 特性 。4. 3 节 讨 论 环 境 表 征 的 估 
计 ， 可 利用 包括 参数 化 和 非 参 数 化 途径 在 内 的 多 种 不 
同方 法 。4. 4 节 描 述 多 种 环境 表征 方法 ， 适 用 于 基于 
模型 的 信息 融合 。 
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据 ， 例 如 ， 佑 计 移 动机 器 人 的 位 置 需要 融合 来 自 于 转 


4.1 感知 过 程 轴 编 码 器 、 视 觉 系 统 、 全 球 定位 系统 (GPS) 和 惯性 
传感器 的 数据 。 
感知 过 程 的 输入 通常 有 两 种 ，@D 来 源 于 各 种 传 感 为 进一步 组 织 本 章 讨论 ， 我 们 采用 如 图 4. 1 所 示 


器 /转换 器 的 数字 信号 ，@) 不 完整 的 环境 模型 (世界 ”的 感知 过 程 通用 模型 。 在 该 模型 中 ,包括 了 适用 于 利 
模型 ) ， 包 含 机 器 人 和 外 部 世界 中 其 他 相关 实体 的 状 ”用 世界 模型 融合 传感器 数据 的 最 常用 操作 。 针 对 所 讨 
态 信 息 。 传 感 器 数据 本 身 可 以 是 多 种 不 同 的 格式 ， 例 论 的 任务 ， 某 些 模 块 可 能 缺席 ， 而 另外 一 些 模块 自身 
如 标量 或 者 是 基于 时 序 x(1) 获取 的 向 量 x(a, 6)， ”可 能 包含 复杂 的 结构 。 但 是 ， 所 提供 的 模型 足以 用 来 
扫描 量 x (0), ， 向 量 场 * 或 者 三 维 容积 x(p，0, 6). ”解释 传 感 与 预测 中 的 许多 问题 。 接 下 来 本 节 将 通过 一 
在 许多 情况 下 ， 系 统 必须 融合 来 自 多 个 传感器 的 数 ”个 移动 机 器 人 定位 的 范例 来 解释 这 个 模型 。 


E 2 
特征 提取 匹配 《关联 ) 更 新 模型 整合 E 


图 4 1 本 章 所 讨论 的 感知 过 程 范例 


aes 
= 
E B. 


传感器 处 理 的 初始 问题 是 数据 预 处 理 和 特征 提 HO, A 4.2 中 所 示 的 激光 扫描 仪 。 一 旦 传感器 信息 
取 。 预 处 理 的 目的 是 降低 转换 器 的 噪声 ， 移 除 任何 系 ”可 用 ， 通 常 需要 将 数据 与 已 有 的 模型 进行 匹配 ( 见 
统 化 误差 ， 优 化 数据 的 相关 属性 。 在 某 些 情况 下 , 传 ” 图 4.3)。 该 模型 可 能 基于 一 个 预知 的 结构 (例如 ， 
感 器 信息 需要 在 时 域 或 空域 进行 校准 以 进行 下 一 步 的 ”环境 的 一 个 计算 机 辅助 设计 (CAD) 模型 ) 或 者 由 
融合 。 有 很 多 种 方式 可 用 来 预 处 理 数 据 ， 以 优化 或 者 。 之 前 获取 的 数据 所 建立 。 数 据 关联 方法 通常 用 于 估计 
提取 特征 用 于 数据 融合 。 常 用 的 一 种 方法 是 模型 荡 ”传感器 数据 与 环境 模型 之 间 的 关系 。 在 我 们 的 移动 机 
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图 4.2 从 激光 扫描 进行 特征 提取 的 范例 (参考 文献 [42] ) 
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顺 人 定位 范例 中 ， 所 提取 的 直线 特征 与 一 个 多 边 形 世 ”化 新 的 传感器 读数 的 数据 关联 ， 见 图 4. 1。 


界 模型 相 匹配 。 该 匹配 过 程 可 经 由 几 种 不 同 的 方式 进 下 面 我 们 将 详细 讨论 感知 过 程 的 每 一 个 步骤 。 
IF, 但 是 总 体 上 ， 它 是 一 个 以 最 大 化 特征 与 模型 之 间 
的 校准 为 目标 的 优化 问题 。 4.2 传感器 

y 


根据 测量 的 对 象 以 及 如 何 测量 ， 有 很 多 种 方式 来 
对 传感器 进行 归 类 。 如 前 所 述 ， 本 体感 受 传 感 器 用 来 
测量 机 器 人 的 内 部 状态 ， 包 括 具 有 不 同 自 由 度 的 位 
置 、 温 度 、 关 键 部 件 的 电压 、 电 动机 电流 、 倪 动 需 受 
力 等 等 。 在 另 一 方面 ， 外 感受 传感器 生成 外 部 环境 的 
有 关 信 息 ， 例 如 与 某 物体 的 距离 、 相 互 作用 力 、 组 织 
的 密度 等 。 

传感器 也 可 以 区 分 为 被 动 或 者 是 主动 类 型 。 总 体 
上 ， 主 动 型 传感器 将 能 量 释放 到 环境 中 ， 并 基于 反应 
一 旦 传感器 数据 与 世界 模型 匹配 之 后 ， 可 利用 传 ”来 测量 环境 属性 。 被 动 型 传感器 则 不 会 主动 测量 。 由 


{W} 


图 4.3 用 于 移动 机 器 人 定位 的 环境 模型 
范例 (参考 文献 [42] ) 


感 器 数据 所 包含 的 信息 来 更 新 模型 。 在 上 述 范 例 中 ， ”于 主动 型 传感器 对 被 测 信号 施加 某 种 控制 ， 所 以 它们 
机 器 人 相对 于 世界 模型 的 方向 和 位 置 可 通过 匹配 的 直 ”通常 比 被 动 型 传感器 更 具 鲁 棒 性 。 例 如 ， 执 行 特征 匹 
线段 来 更 新 如 图 4. 4 所 示 。 配 以 进行 三 角 化 时 ， 被 动 型 立体 相机 系统 必须 依赖 于 


所 观察 表面 的 外 观 ( 见 第 22 章 ) ， 然 而 结构 光 系 统 
将 某 种 模式 光 投射 人 场景 ， 因 此 对 场景 的 特征 不 是 很 


\ 敏感 。 即 使 如 此 ， 所 发 射 信号 的 吸收 、 散 射 或 者 干扰 
会 影响 主动 型 传 感 占 的 性 能 。 
@ 本 体感 受 传 感 器 通常 是 被 动 型 ， 用 来 测量 机 器 人 
的 物理 属性 ， 例 如 关节 位 置 、 速 度 ， 或 者 加 速度 、 马 


达 扭 矩 等 。 另 一 方面 ， 外 感受 传感器 可 进一步 划分 为 
接触 式 传 感 型 和 非 接触 式 传 感 型 。 接 触 式 传感器 通常 
与 本 体感 受 所 使 用 的 传感器 是 同一 类 型 ， 而 非 接触 式 
传感器 包含 绝 大 多 数 以 一 定 距 离 估计 物理 属性 的 传 感 
类 型 ， 包 括 强 度 、 范 围 、 方 向 、 尺 寸 等 。 
最 后 ， 设 计 一 个 动态 系统 模型 来 模拟 待 估计 的 相 表 4.1 列 出 了 按照 使 用 方法 和 典型 应 用 对 典型 传 


图 4.4 估计 移动 机 器 人 实例 的 位 置 和 
方向 (参考 文献 [42] ) 


关 状 态 是 有 可 能 的 。 通 过 这 样 的 系统 模型 ， 在 获取 到 感 器 进行 的 分 类 。 有 关 传 感 方法 ， 传 感 器 特征 和 常见 
新 的 传感器 数据 之 前 预测 环境 随时 间 的 变化 是 可 能 ”应 用 的 更 多 细节 可 以 在 诸如 现代 传感器 手册 “” 和 本 
的 。 该 方法 可 用 于 前 馈 型 预测 过 程 ， 并 可 以 反 过 来 简 ”手册 第 3 篇 找到 。 


表 4.1 根据 传 感 对 象 ( 本 体感 受 (PC)/ 外 感受 (EC)) 和 使 用 方法 
(主动 式 / 被 动 式 ) 对 机 器 人 常用 传感器 的 分 类 


分 类 传感器 类 型 传 感 方 式 主动 (A)/ 被 动 (P) 
开关 /缓冲 器 EC P 

触 压 式 传感器 HER EC A 
近 程 传感器 EC P/A 
接触 矩阵 EC P 

触觉 传感器 J/H PC/EC P 
阻抗 式 传感器 EC P 
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(E) 
分 cx ft gig ang 传 感 方式 主动 (A)/ 被 动 (P) 
电 刷 编码 器 PC P 
电压 计 PC P 
分 解 器 PC A 
马达 /转轴 传感器 光学 编码 器 PC A 
磁性 编码 器 PC A 
电感 式 编码 器 PC A 
电容 式 编码 器 EC A 
指南 针 EC 
方位 传感器 陀螺 仪 PC 
倾斜 仪 EC A/P 
GPS EC A 
主动 式 光 学 传 感 EC A 
基于 信 标 的 传感器 Suet 
相对 于 某 惯性 坐标 系 的 位 置 ) : 
pean 超声 信 标 EC A 
反射 式 信 标 EC A 
电容 式 传感器 EC P 
磁性 传感器 EC P/A 
机 EC P/A 
范围 传感器 m 
声呐 EC A 
激光 测 距 仪 EC A 
结构 光 EC A 
多 普 勒 雷达 EC A 
8 多 普 勒 声波 EC A 
度 / 运 动 传 感 
速度 /运动 传感器 相机 n " 
加 速 计 EC P 
相机 EC P 
无 线 射 频 识 别 (RFID) EC A 
UNE 激光 测 距 仪 EC A 
识别 传感器 雷达 ae M 
超声 EC A 
声波 EC A 


旋转 运动 的 估计 是 控制 机 械 手 和 估计 移动 系统 自 
主 运动 的 基础 。 测 量 旋转 运动 最 常见 的 传感器 是 正 交 
编码 器 。 它 由 一 个 透明 盘 片 组 成 ， 具 备 两 种 异 相 的 周 
期 性 模 态 ， 如 图 4.5 所 示 。 通 过 计数 器 ， 可 以 直接 计 
算 位 移 和 方向 (图 4.5 中 传感器 A 和 了 B 之 间 的 相 
位 ) 。 而 且 ， 盘 片 外 边缘 通常 刻 有 小 洞 来 提供 标 引 
(规定 零 位 ) 。 图 案 的 密度 决定 测量 的 解析 度 。 将 该 
传感器 安装 至 马达 减速 齿轮 的 上 游 ， 精 确 度 可 轻易 超 。 估计。 这 些 单元 产生 的 电压 值 与 引入 的 变形 量 成 正 
过 1/1000°。 比 。 通 过 谨慎 地 布置 传感器 ， 可 同时 测量 受 力 和 扭 

末端 执行 器 处 的 受 力 和 扭矩 可 以 采用 压 电 单元 来 ”和 矩 。 这 种 传感器 用 于 机 器 人 操纵 中 估计 应 力 和 接触 ， 


图 45 正 交 编 码 器 盘 片 图 ， 以 及 光 侦 测 器 在 两 种 
模式 下 的 输出 ( 相应 的 状态 变化 示 于 图 右 侧 ) 
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作为 装配 系统 的 一 部 分 ， 除 飞 边 等 ， 也 用 于 医疗 领 
域 。 市 面 上 的 力 /扭矩 传感器 有 着 各 种 尺寸 和 动态 范 
围 ， 包 括 新 型 的 可 安装 在 不 同 末端 执行 器 上 的 灵活 阵 
列传 感 器 〈 见 图 4.6) 。 力 传感器 的 潜在 问题 是 初始 


接触 存在 不 工作 区 ， 以 及 基本 传 感 环节 产生 干扰 信 
号 ， 需 要 通过 信号 处 理 来 清除 。 


图 46 灵活 阵列 传感器 
a) fishin pep Pressure Profile Systems 公司 所 生产 的 
种 灵活 的 电容 性 接触 式 传感器 阵列 ， 适 用 于 滑动 状态 
下 的 接触 位 置 和 区 域 传 感 ) b) 触觉 阵列 传感器 可 以 舒 
服 的 戴 在 人 手 或 者 机 器 人 手 上 (Pressure Profile Systems 
公司 许可 提供 ) 


一 


自主 运动 的 估计 是 几乎 所 有 机 器 人 系统 的 重要 一 
环 。 为 此 ， 可 应 用 惯性 测量 单元 (IMU)。IMU 通常 
包括 加 速度 计 和 陀螺 仪 。 加 速度 计 对 各 种 类 型 的 加 速 
度 都 敏感 ， 意 味 着 可 一 起 测量 平 动 和 转动 (离心 
J)o IMU 单元 可 以 估计 旋转 和 平 动 ， 可 通过 二 重 积 
分 来 估计 系统 的 速度 、 方 位 和 位 置 ， 参 见 参考 文献 
[4.4] 中 的 范例 。IMU 使 用 中 存在 的 一 个 问题 是 需 
要 进行 二 重 积分 。 小 的 偏 移 和 干扰 可 造成 最 终结 果 的 
严重 偏离 ， 因 此 需要 详细 的 传感器 模型 ， 并 对 传感器 
进行 谨慎 矫正 和 特征 识别 。 图 4.7 给 出 了 行驶 于 沙土 
路 面 的 汽车 上 所 装配 的 十 字号 形 DMU-6x 型 单元 的 数 
据 范例 。 

最 早期 的 移动 机 器 人 、 水 下 机 器 人 以 及 某 些 医疗 
机 器 人 的 研究 依赖 于 超声 测 距 。 通 用 的 此 类 传感器 常 
被 称 为 声波 导航 与 测 距 仪 (声呐 )。 一 般 原理 是 系统 
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图 4.7 用 于 沙土 路 面 驾 驶 的 IMU 单元 的 数据 范例 


释放 出 声波 脉冲 ， 并 等 待 其 碰 到 环境 中 的 物体 之 后 反 
弹 回来 。 已 知 介质 中 的 传递 速度 和 声波 传递 所 用 的 时 
间 ， 可 以 计算 出 距离 。 因 为 这 种 低 成 本 的 传感器 可 以 
提供 适中 的 性 能 ， 所 以 该 方法 广泛 应 用 于 早期 机 器 
人 。 目 前 ， 声 呐 仍然 是 水 下 机 器 人 采用 的 主要 传感器 
类 型 。 第 21 章 将 详细 讨论 这 种 传感器 。 

近期 的 机 器 人 进展 ， 特 别 是 环境 模拟 和 导航 ， 在 
许多 方面 都 归功 于 低 成 本 高 灵敏 度 激光 扫描 系统 的 出 
现 。SICK 系列 激光 扫描 仪 属于 渡 越 时 间 型 扫描 仪 。 
扫描 仪 放出 光 脉 冲 ， 并 测量 返回 所 需 时 间 ， 如 图 4.8 
所 示 。 在 厘米 或 者 毫米 级 精确 度 下 ， 标 准 扫描 仪 测量 
距离 可 高 达 80m。 扫 描 仪 在 一 个 平面 上 以 0.5° ~1° 的 
角 分 辨 率 测量 距离 。 可 视角 度 180"， 产 生 181 ~ 361 
次 测量 。 均 匀 分 布 干扰 会 污染 传感器 数据 ， 这 一 点 在 
等 征 识别 或 者 将 数据 融合 为 原始 传感器 地 图 时 必须 加 
以 考虑 。 


图 4.8 广泛 用 于 移动 机 器 人 的 激光 测 距 
传感器 示例 (SICK LMS291 ) 
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对 传 感 和 估计 来 说 ， 图 像 传感器 是 丰富 的 信息 来 
源 。 图 像 传感器 有 多 种 不 同 的 配置 ， 例 如 不 同 的 几何 
成 像 、 图 像 解 析 度 、 传 感 器 技术 以 及 传 感 频谱 。 大 部 
分 读者 一 定 都 很 熟悉 传统 的 3CCD 透视 彩色 相机 。 该 
设备 含有 3 组 电荷 耦合 探测 器 (CCD) 阵列 ， 分 别 接 
受 对 应 人 有 眼 视觉 的 红 、 绿 和 蓝 色 的 可 见 光 谱 部 分 。 更 
常见 且 较 便宜 的 一 种 替代 设备 称 为 单 芯 片 CCD 相机 。 
该 设备 采用 一 组 空间 特别 排列 的 滤 色 镜 ， 通 称 为 拜 尔 
滤 镜 ， 因 它 的 发 明 人 布 赖 斯 ， 拜 尔 而 得 名 。 滤 镜 组 再 
进一步 处 理 〈 称 为 去 马赛 克 处 理 ) ， 以 提供 每 一 个 像 
素 点 的 色彩 信息 。 

在 美国 ， 根 据 为 电视 信号 模拟 传输 制定 的 NTSC 
标准 ， 图 像 传感器 传统 上 包含 480 行 ， 每 行 640 MR 
素 点 。 对 应 的 欧洲 标准 PAL 包含 576 线 ， 每 线 768 个 
像素 点 。 最 近 ， 数 字 式 接口 的 演化 ， 例 如 IEEE 1394 
All USB 2. 0 已 经 允许 相机 系统 的 解析 度 达 到 百 万 像素 
的 范围 。 与 此 同时 ， 成 本 较 低 廉 的 红外 (IR) 和 紫 
外 光 (UV) 照相 机 也 出 现 了 ， 因 此 可 以 开发 更 高 和 
的 多 谱 段 图 像 处 理 系统 。 

传统 图 像 传感器 含有 一 个 光学 系统 ， 将 光 汇 聚 在 
一 个 平面 图 像 阵列 上 。 大 多 数 时 候 ， 该 系统 可 以 用 经 
典 的 针 孔 相机 模型 ( 见 图 4.9) 来 模拟 。 给 定 欧 几 里 
德 空 间 中 的 一 个 点 〈(*，y，z) ， 对 应 的 照相 机 像素 
坐标 (u, v) 为 


式 中 , /是 镜头 系统 的 焦距 ; uH v ERI obs m 
像素 坐标 ; s, 和 s, 是 图 像 阵列 上 单个 像素 点 的 尺寸 。 
实际 应 用 中 ， 这 些 模 型 也 可 用 低 阶 图 像 失 真 模型 来 加 
以 补充 。 对 于 一 个 给 定 的 相机 系统 ， 这 些 参数 值 可 通 
过 多 种 试验 方法 来 确定 |。 
将 传统 的 透视 相机 与 反光 镜 组 合成 所 谓 的 反 
射 折射 光学 系统 ， 生 成 的 图 像 几何 可 将 宽度 达 半 
球体 的 视野 映射 至 单 幅 图 像 。 该 系统 有 很 多 用 处 ， 
璧 如 监控 系统 ， 该 系统 的 几何 属性 可 为 移动 导航 
提供 稳定 的 定位 参考 。 图 4. 10 给 出 了 一 幅 图 
像 示 例 ， 以 及 该 图 像 映 射 到 圆柱 体 表 面 所 生成 的 
图 像 。 
上 述 讨论 涉及 最 常用 的 机 器 人 传 感 设备 。 在 
特定 的 应 用 中 会 用 到 很 多 专用 传感器 ， 它 们 在 制 


图 4.9 针 孔 相机 模型 


图 4.10 反射 折射 图 像 和 将 其 映射 到 
圆柱 体 表面 生成 的 图 像 


项 。 关 于 这 些 更 具有 目标 指向 性 的 传 感 形 式 的 更 
深层 讨论 ， 可 以 参考 本 手册 第 3 篇 的 应 用 章节 。 


4.3 估计 过 程 


简介 部 分 提 到 可 用 多 种 不 同 的 方法 对 来 自传 感 器 


药 (第 52 章 ) 领域 、 超 声 、X 射线 、 计 算 机 上 断层 
扫描 和 磁 共 振 成 像 中 被 广泛 应 用 ; 在 矿坑 制图 中 
使 用 穿 地 雷达 中 。 水 下 机 器 人 利用 多 种 声学 传 感 


的 信息 进行 综合 。 哪 一 种 方法 更 适合 很 大 程度 上 依赖 
于 对 环境 的 事先 了 解 程度 ， 何 种 信息 是 当前 任务 所 必 
需 的 ， 以 及 哪 种 模型 更 适合 传 感 系统 。 常 见方 法 包括 
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基于 表决 的 简单 方法 ， 参 数 型 和 非 参 数 型 统计 估计 
法 ， 模 糊 逻 辑 系统 和 Dempster- Shafer 证 据 理论 。 

为 说 明 这 一 点 ， 让 我 们 再 考虑 4.1 节 介 绍 的 机 器 
人 定位 问题 。 如 果 一 开始 对 环境 一 无 所 知 ， 机 器 人 可 
能 接收 激光 扫描 信号 并 试图 用 直线 段 来 产生 初始 环境 
模型 。 因 为 事先 一 无 所 知 ， 系 统 必须 估计 线段 的 数量 、 
线段 与 数据 观测 值 之 间 的 数据 关联 以 及 线段 本 身 的 参 
数 。 这 个 问题 具有 挑战 性 ， 可 采用 简单 表决 技术 求解 ， 
例如 霍 夫 变 换 引 或 者 随机 抽样 一 致 ( RANSAC) 
法 天 9 或 者 更 复杂 的 无 监督 型 集群 方法 ， 例 如 k 均 
值 * ， 最 大 期 望 值 (EM) "*"") ， 或 者 全 局 主 成 分 分 
析 (GPCA) 方法 中， 在 许多 情况 下 ， 这 是 一 个 演 
算 密集 的 迭代 过 程 。 
相反 ， 如 果 已 知 环境 的 CAD 模型 ， 问 题 演 变 为 
生成 少数 几 个 模型 参数 ( 平 动 和 转动 ) 以 匹配 数 
据 。 该 问题 可 通过 特征 匹配 来 求解 ， 利 用 迭代 最 近 
点 算法 (1CP)* 中 或 者 其 他 有 效 的 组 合 匹 配 算 法 例 
如 蒙特 卡 洛 法 “* 申 ， 将 观察 点 与 模型 比 对 。 何 种 方 
法 最 适合 很 大 程度 上 仍然 依赖 于 环境 的 结构 和 事先 
所 知 。 

对 环境 有 了 初始 了 解 之 后 ， 新 的 数据 可 以 利用 这 
些 已 有 知识 。 特 别 是 当 机 器 人 移动 时 ， 传 感 器 数据 应 
该 以 可 预知 的 方式 变化 。 因 此 ， 如 果 传 感 系统 合适 的 
统计 特征 可 用 ， 可 以 采用 预测 修正 子 方法 例如 山 尔 曼 
滤波 中 或 者 连续 关键 取样 "1。 如 果 存 在 数据 关 
联 问题 ， 可 以 采用 一 系列 通用 技术 例如 EM ^ 或 者 
前 述 的 预测 修正 子 方法 的 变种 中 2 。 
偶尔 无 意义 的 数值 往往 造成 传感器 数据 损坏 ， 例 
如 ， 因 为 反射 的 存在 ,我 们 范例 中 的 激光 测 距 仪 可 能 
偶尔 会 返回 错误 的 范围 度数 。 许 多 常用 的 估计 技术 对 
所 谓 的 数据 离 群 值 并 不 具 和 鲁 棒 性 。 在 这 种 情况 下 ， 重 
棒 统 计 类 方法 “中 可 以 用 来 提高 传 感 和 估计 系统 的 
性 能 。 

最 后 ,我 们 可 能 要 考虑 对 当前 的 任务 而 言 哪些 信 
息 是 重要 的 。 上 述 方法 中 大 多 数 都 假定 目标 是 要 产生 
与 当前 数据 本 身 密切 相关 的 一 系列 连续 参数 的 准确 估 
计 。 然 而 ， 在 某 些 任务 中 ， 我 们 对 参数 值 本 身 可 能 并 
不 感 兴趣 。 人 例如， 假设 我 们 机 器 人 的 目标 是 通过 一 个 
门口 ， 虽 然 这 明显 取决 于 估计 门 宽度 (一 个 连续 参 


特定 的 门 〈 需 要 重新 寻找 替代 路 线 ) 相对 成 本 可 能 
更 低 。 反 之 ， 如 果 任务 紧急 ， 可 以 容许 机 器 人 采取 更 
加 危险 的 行为 。 

对 于 任何 给 定 的 任务 RRR), 决策 所 需要 的 
信息 量 可 能 会 有 所 不 同 ， 例 如 ， 如 果 门 口 很 宽 ， 机 咒 
人 只 需要 相对 少量 信息 就 可 以 安全 地 通过 。 反 之 ， 如 
果 门 口 很 窄 ， 机 器 人 作出 决定 前 需要 仔细 检查 。 确 定 
作出 某 项 判断 所 需 的 信息 类 型 和 数量 这 一 问题 有 不 同 
的 称谓 ， 顺 序 抽样 问题 *” ， 传 感 器 控制 问题 ， 或 传 
感 器 规划 问题 *””|。 


点 估计 


在 我 们 的 机 器 人 定位 范例 中 ， 有 几 种 情况 下 问题 
的 关键 是 要 估计 出 一 个 可 表示 为 向 量 空间 中 的 一 个 点 
的 未 知 数量 。 例 如 二 维 (2-D) 或 者 三 维 (3-D) 点 
的 位 置 或 者 机 器 人 的 位 置 。 还 有 的 情况 下 ， 问 题 是 确 
定 机 器 人 的 姿势 (位置 和 方向 )， 或 者 一 条 线段 的 参 
数 。 后 者 的 不 同 点 在 于 其 参数 空间 不 属于 向 量 空间 ， 
这 会 引入 一 些 额 外 的 独特 问题 。 进 一 步 的 讨论 我 们 推 
荐 读者 阅读 文献 [4.24，25] ， 在 本 章 剩 余 的 部 分 我 
们 将 只 讨论 向 量 空间 上 的 点 估计 问题 。 在 我 们 的 讨论 
中 ， 我 们 假设 读者 熟悉 多 元 高 斯 分 布 ”| 和 初等 线性 
GRUT, 

本 节余 下 部 分 中 ,我们 考虑 如 下 基本 问题 。 

给 定 : 观察 模型 

y=f(x, m) (4.2) 

估计 : xe Re(z) ， 基 于 观察 y e Re(m), n 为 未 
知 干扰 ， 其 值 为 Re(k) ; f AM Re(k+n) 至 Re(m) 
的 已 知 映射 。 

我 们 的 讨论 分 为 两 个 主题 区 域 : 

1) 当 了 为 线性 时 ， 对 成 批 和 顺序 数据 的 估计 
方法 。 
2) 当 了 为 非 线 性 时 ， 对 顺序 数据 的 估计 方法 。 

1. 当 /为 线性 时 ， 对 成 批 和 顺序 数据 的 估计 方法 

本 节 我 们 讨论 对 顺序 数据 的 线性 和 非 线性 估计 方 
法 ， 包 括 凯 尔 曼 滤 波及 其 扩展 。 我 们 的 目的 是 提供 现 
有 方法 的 概述 。 更 多 信息 ， 读 者 可 参考 更 深入 的 相关 
文献 ， 例 如 文献 [4.16, 28, 29] 和 第 25 章 。 

我 们 首先 考虑 式 (4.2) 中 了 为 线性 的 情况 。 在 


4.3.1 


ZO 的 能 力 ， 最 终 的 决策 具有 二 分 性 。 该 问题 可 整 
理 为 一 个 决策 问题 。 而 决策 问题 可 以 使 用 决策 理 
论 * ”的 概念 来 进行 模拟 ,包括 零 一 损失 函数 ， 似 然 
比 ， 或 概率 比率 。 例 如 ， 在 机 器 人 通过 门口 问题 中 ， 
如 果 任 务 的 优先 级 低 ， 与 其 试图 通过 一 个 太 小 的 缺口 
( 冒 着 损坏 机 器 人 或 门 ， 或 两 者 的 危险 )， 不 通过 该 


该 情况 下 
y =Fx+Bn (4.3) 
FeRe(mxn) 定义 未 知 量 x 与 观察 量 y ZPW (A 
TE) 关系 ，Be Re(m xn)。 我 们 暂时 略 过 B 并 假设 
n 代表 系统 的 完整 干扰 模型 。 
用 最 小 二 乘 方 法 由 y 来 估计 *， 需 要 求解 下 列 优 
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化 问题 
(4.4) 


MBBUCRS ABE F 为 满 秩 ， 该 优化 问题 存在 唯一 解 x. 
此 时 ,求解 如 下 线性 系统 可 得 到 优化 问题 的 解 : 

F'Fi-F'y (4.5) 

在 某 些 情况 下 ， 有 理由 相信 部 分 观测 元 素 比 另外 

的 元 素 更 可 靠 ， 因 此 对 最 终 的 估计 应 该 贡献 更 多 。 可 

以 修改 式 (4.4)， 包 含 一 个 对 角 正 定 加 权 和 矩阵 来 整 

合 这 类 信息 


min || Fx — y |f 
x 


min(Fx - y) WCFx - y) (4.6) 
求解 下 列 等 式 可 得 到 解 
(FWF)$ =F "Wy (4.7) 


BAR (4.3) 包含 了 干扰 项 (用 7 Ra), X 
(4.5) 或 者 式 (4.7) 并 没有 直接 用 到 该 数量 。 但 
是 ， 我 们 通常 可 以 用 统计 模型 来 模拟 传感器 的 噪声 特 
征 ， 调 整 原 本 的 估计 问题 来 整合 该 信息 。 常 见 的 一 种 
方法 是 极 大 似 然 估 计 (MLE) 法 ,得 到 的 4 值 ， 满 足 
p(y |%) =maxp(y| x) (4.8) 
对 于 式 (4.3) 代表 的 线性 附加 模型 ， 似 然 函 数 可 用 
特别 简单 的 形式 表达 。 假 设 ny 用 固定 已 知 的 概率 密 
FE PRM D 来 表示 ， 似 然 函 数 可 表示 为 
p(y |x) =D(y - Fx) (4.9) 
MLE 与 前 面 提 到 的 最 小 二 乘 方法 相关 联 。 假 设 
9-N(O, 4)，N 代表 均值 为 0， 方 差 为 4 的 多 元 高 
斯 密度 函数 。 观 察 可 知 ， 最 大 化 似 然 函 数 的 值 等 效 于 
最 小 化 似 然 函数 的 负 自 然 对 数 ， 一 系列 简短 的 计算 表 
HW, W A 时 的 加 权 最 小 平方 可 计算 得 到 优化 的 
最 大 似 然 估计 。 
最 后 ， 有 些 参数 比 其 他 的 更 容易 预知 。 例 如 ， 当 
观察 一 辆 汽车 在 高 速 公 路 上 行使 时 ， 每 小 时 60mile 
的 速度 比 20mile 或 者 300mile 更 可 能 发 生 。 该 信息 可 
通过 对 未 知 变量 % 的 预先 统计 来 获取 。 
给 定 x 上 的 先 验 概 率 密度 p(x), ， 由 贝 叶 斯 理论 
可 知 


p(y|x)p(x) PCY|z)P(z) 
p(y) [py |x) pC) dx 
(4. 10) 


p(x|y) 7 


最 大 后 验 概率 (MAP) fü 2 WE 
p(X |y) =maxp(x| y) (4. 11) 
一 般 而 言 ， 该 优化 问题 的 解 可 以 非常 复杂 。 与 其 
进一步 探求 该 过 程 ， 我 们 考虑 一 种 替代 方案 。 也 就 是 
Bi, WR p(x 17y) 的 二 阶 矩 存在 ， 通 过 求解 下 列 包含 
未 知 函数 6 的 优化 问题 有 可 能 以 统计 学 方式 生成 最 小 


二 乘 估计 
min |5Cy) -x| (4.12) 
也 就 是 说 ， 最 优 函 数 8 是 由 y 产生 的 具有 最 小 均 方 误 
35 (MMSE) 的 * 估计 。 因 此 估计 子 8 通常 也 称 为 最 
小 均 方 误差 估计 子 。 
可 以 证 明 ， 在 一 般 情况 下 ， 优 化 决策 法 则 5” 为 
条 件 均值 


6 (y) -E[x | y] (4.13) 
遗憾 的 是 ， 如 同上 面 定义 的 MAP 估计 ， 该 表达 式 
在 一 般 情况 下 计算 极其 困难 。 稍 后 我 们 考虑 计算 式 
(4.13) 的 近似 值 。 现 在 我 们 再 次 考虑 之 前 式 (4.3) 
所 代表 的 线性 观察 模型 (去除 B). FFE, 我 们 假设 x 
Mn 为 二 阶 和 矩 有 限 的 独立 随机 变量 ， 均 值 都 为 0。 请 
注意 后 者 并 不 是 真正 的 约束 ， 因 为 它 可 以 通过 简单 定 
义 一 个 新 变量 x' =x- Elx] 来 实现 。 最 后 ， 我 们 只 考 
虑 线性 函数 5， 也 就 是 说 ,我 们 可 以 写 *=6(y) = Ky. 
式 (4.12) 可 以 扩展 为 
E||6(y) -x |} =E ||Ky -x |È 
=E||K(Fx +n) -x| 
= E|| KF -1)x|È + E ||Kn |P 
=t[(KF -1)A (KF - 1)! -KXK'] 
(4. 14) 
此 处 ， 因 为 * 和 7 彼此 独立 ， 并 且 它 们 的 均值 都 
为 零 ， 所 以 有 几 项 被 消除 。 最 后 一 步 推导 利用 了 
x =wr(x x )o 
对 KK 求 导数 ， 并 设 其 等 于 零 ， 可 得 以 下 结果 
K-AF'(FAF'«X)' (4.15) 
bp, AXPE W T, BUG Yr Ze 0U (6 3 Ze HE | 
数 ， 线 性 项 只 依赖 于 随机 变量 以 及 定义 观测 系统 的 线 
性 项 的 方差 。 


WR x 的 均值 凡 不 为 零 ， 不 难得 到 优化 估计 为 
&-Ky* (I -KF)y (4.16) 

估计 的 方差 A' 为 
A* - (I- KF)A (4.17) 


感 兴趣 的 读者 可 能 希望 得 到 一 些 简化 情况 下 的 解 ， 例 
Ay, HURA-E,F-I, K-12I, 那么 人 =y + 为 
HRE, 方差 为 4* =1/2A, 

2. 卡尔 曼 滤 波 

有 了 上 述 背景 ， 我 们 接 下 来 定义 线性 系统 的 离散 
时 域 卡尔 曼 - 布 西 滤波 * ”i 。 考 虑 下 述 时 序 模型 
(4.18) 

y,=Fx, +N, (4.19) 

APF, G 是 描述 系统 时 间 变 化 的 xz 和 矩阵 ; wo 服从 
HEN x), 方差 为 4 的 高 斯 分 布 。 并 且 ， 由 和 水 相 


X,,4 2 Gx, +w, 
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对 于 所 有 时 间 上 均 为 零 均 值 高 斯 独立 随机 变量 ， 对 于 
所 有 1 关 t，w, 独 立 于 w,,， 与 之 类 似 ， 对 于 所 有 cU, 
n AUT n,. BUA, 9,2028 X,, w TEN Qo 
给 定 一 个 观测 y, ， 根 据 前 面 章节 的 推导 ， 可 以 计算 
出 方差 为 A 的 新 的 估计 *,。 注 意 ， 解 为 两 个 高 斯 随 
机 变量 的 线性 组 合 : 观测 值 y, 以 及 之 前 的 估计 值 o o 
因为 任何 高 斯 随机 变量 的 线性 组 合 仍 为 高 斯 随机 变 
量 ， 所 以 更 新 后 的 估计 仍 服 从 高 斯 分 布 。 

现在 我 们 通过 动态 模型 进行 投影 。 为 便于 描述 ， 
用 上 角 标 减 号 和 加 号 分 别 代表 估计 步 又 之 前 与 之 后 。 
因此 ， 给 定 方差 为 4 的 估计 t+ ， 往 前 一 步 时 间 的 投 


E24 FH -> 
影 结果 为 


Xu = Gx (4.20) 

A,,, 2GA/ G" +Q, (4.21) 

此 时 ， 系 统 获取 到 一 次 新 的 观测 y ,,， 上 述 步骤 开始 

循环 重复 。 图 4. 11 总 结 了 线性 系统 完整 的 卡尔 曼 滤 
波 算法 。 


B Aja F (FA; Ftd)! | 
(M-K F)A m 


卡尔 曼 滤 波 算法 小 结 


图 4.11 


可 以 证 明 在 给 定 假设 条 件 下 ， 卡 尔 曼 滤 波 为 均 方 
优化 滤波 。 在 其 中 一 个 或 者 两 个 高 斯 分 布 假设 不 成 立 
的 情况 下 卡尔 曼 滤波 仍 为 优化 线性 滤波 。 

3. 连续 数据 的 非 线性 估计 方法 

上 一 节 的 结果 假设 观测 值 与 系统 状态 ， 附 加 噪声 
之 间 的 关联 为 线性 形态 ， 系 统 的 状态 变化 也 可 用 线性 
关系 来 表述 。 并 且 ， 对 于 观测 值 服从 高 斯 分 布 ， 噪 声 
具 传 递 性 的 系统 ， 该 结果 为 全 局 最 优 ， 如 果品 声 源 为 
非 高 斯 分 布 ， 则 该 解 仅 为 最 优 线性 佑 计 子 。 

正如 一 开始 提 到 的 ， 更 通用 的 非 线 性 (离散 时 
间 ) 系统 描述 为 


Meat =g,(%,) +w, 
y=f(x) +7, 
这 里 ， 噪 声 模 型 暂 为 附加 项 。 


(4.22) 


虽然 该 模型 含有 非 线性 项 ， 对 当前 估计 的 非 线性 
项 进行 泰勒 级 数 展开 ， 仍 可 能 应 用 卡尔 曼 滤波 的 变 体 
形式 ， 即 扩展 卡尔 曼 滤 波 (EKF) 。 用 也 代表 函数 / 
的 雅 可 比 矩 阵 。 假 设 时 步 为 - 1 时 估计 存在 ， 式 
(4.22) 在 该 点 的 一 阶 扩展 为 


X, =g,(%,.1) ZACESIC -5,4) +w, 


(4.23) 

Yi ACE + Jin, 7 8,4) +N, (4.24) 
加 以 整理 可 得 到 适合 之 前 定义 的 卡尔 曼 滤波 的 线性 
形式 


T ^ ^ ^ 
Xi+l = Yetl -g, X) tI, % 21 =I,%, +w, 


(4.25) 

y,2y,- ORA) Ja =J,%, +1, (4. 26) 
st (4.25) Fist (4.26) P, x 与 y 为 新 的 合成 状 
态 和 观测 变量 ， 几 扮演 G 的 角色 , J, PF fi C. 

值得 注意 的 是 ，EKF 和 迭代 在 本 质 上 是 一 种 加 权 
牛顿 迭代 ， 即 一 种 循环 非 线 性 估计 方法 。 因 此 ， 保 
持 方差 固定 ， 对 同一 观测 进行 多 次 循环 是 有 用 的 。 
这 样 ， 当 大 的 干扰 或 者 严重 的 非 线 性 存在 时 ,估计 
子 可 以 收敛 得 到 解 。 只 有 收敛 以 后 ， 才 会 更 新 方差 
项 。 这 种 卡尔 曼 滤波 被 称 为 迭代 扩展 卡尔 曼 滤波 
(IEKF) 。 


4.3.2 其 他 估计 方法 


在 前 一 节 ， 我 们 回顾 了 最 常见 和 广泛 应 用 的 估计 
方法 。 然 而 ， 还 有 几 种 替代 方法 可 求解 参数 估计 问 
题 。 这 里 我 们 简单 介绍 两 种 : 连续 关键 取样 和 图 形 
模型 。 

1. 连续 关键 取样 

在 此 之 前 的 讨论 都 集中 在 用 估计 的 均值 和 方差 来 
近似 计算 系统 状态 。 有 一 种 利用 贝 叶 斯 定理 的 蔡 代 方 
法 ， 其 一 般 表 达 式 为 


PCM» yy de p.) 
pn. Y2 Yn) 
(4.27) 
假设 y, 独 立 于 之 前 的 所 有 观测 与 给 定 的 系统 状 
S«,, Arex, AOE, “4k> 1, x, SET «,_,, 
该 表达 式 可 简化 为 


pU, | Yi, Yoon) = 


ply, [x px, 1,1) 


PCa, [3,44 3,) = ple. fe) (4. 28) 
另外 ， 由 条 件 均 值 可 得 到 最 优 均 方 估计 ， 即 
8 (y,) 2 E[x, |y,] (4.29) 


实际 上 ， 我 们 充分 证 明了 卡尔 曼 滤波 是 该 结果 在 含 高 
斯 干扰 的 线性 系统 情况 下 的 特例 。 

通常 情况 下 实现 该 过 程 的 难点 最 终 转 化 为 在 非 线 
性 、 非 高 斯 形态 的 情况 下 进行 表征 和 计算 分 布 的 问 
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题 。 但 是 ， 如 果 假 设 之 前 的 连续 变量 x, 取 值 仅 为 离 
散 数 集 ， 那 么 计算 贝 叶 斯 定理 和 其 他 相关 统计 量 就 简 
化 为 基于 该 离散 数 集 的 直接 计算 。 这 对 于 任何 分 布 和 
任意 转换 都 可 简单 实现 。 

连续 关键 取样 (也 称 为 粒子 滤波 ,凝聚 等 其 他 
字 ) 是 用 统计 学 来 处 理 该 问题 的 一 种 方法 。 为 进 
连续 关键 取样 ， 作 如 下 假设 : 

1) 可 从 似 然 函 数 p(y, | x, ) 进行 取样 。 
2) 可 从 动态 模型 p(x, | x,_,) 进行 取样 。 

注意 取样 的 重点 : 不 需要 显 式 地 展示 似 然 孔 数 或 
者 动态 模型 的 解析 形式 。 

给 定 以 上 假设 ， 连 续 关 键 取 样 的 最 简单 形式 可 以 
写 为 : 

1) Ham, = |<, w>, k=1, 2, <N} 
代表 一 系列 样本 点 x. MBA wh HWE 
Ew! =l, 

2) 计算 N AIRE m, = | ex, IN, 
: 2; eN} o 
(D 按照 与 权 习 
点 xt. 

Q Ex. BUR IN, M P(x, | xh ,) BUE, 

3) 计算 7,= | «xl, Ply, |) >, k=1, 
2; oN} A 
很 容易 看 出 以 上 步骤 为 循环 滤波 的 形式 。 而 且 ， 在 任 
意 时 刻 ， 相 关 分 布 的 任何 统计 量 可 从 样本 集 和 相关 权 
重 来 近似 计算 。 

这 种 形式 的 基于 取样 的 滤波 广泛 应 用 于 用 线性 佑 
计 技术 不 足以 处 理 的 各 种 挑战 性 领域 。 这 些 线性 估计 
技术 对 于 低 状态 维度 GH n3) 和 动力 学 约束 完 
备 的 问题 特别 有 效 。 对 于 高 维 问题 或 者 展现 高 动态 变 
化 的 系统 ， 要 获得 好 的 近似 所 需要 的 粒子 数量 会 太 大 
以 至 于 实际 上 不 可 能 实现 。 然 而 ， 即 便 是 这 样 ， 有 时 
还 是 可 以 应 用 基于 采样 的 系统 来 产生 可 以 接受 的 
结果 。 

2. 图 形 模型 

图 形 模型 代表 一 系列 变量 之 间 依 赖 与 独立 关系 的 
一 类 模型 。 常 见 的 图 形 模型 范例 包括 贝 叶 斯 网 、 影 响 
图 和 神经 网 。 这 里 我 们 以 贝 叶 斯 网 为 特别 范例 来 重点 
讲述 。 

贝 叶 斯 网 络 属于 有 向 无 环 图 ， 用 节点 代表 随机 变 
量 ,， 用 有 向 弧 代 表 随 机 变量 对 之 间 的 概率 关系 。 用 父 
节点 (X) 代表 所 有 弧 中 止 于 站 的 节点 集合 ， 并 用 
X,, X,, cc, Xy RRA PHN 个 随机 变量 。 我 们 有 
以 下 公式 


名 
行 


k=1 
2 成 正比 的 概率 选取 采样 


jum 


N 
P(X,,X, 7, Xy) = II», | parents X;) ) 
i=l 


(4.30) 

作为 范例 ， 图 4.12 所 示 的 贝 叶 斯 网 络 代 表 一 个 

执行 定位 任务 的 移动 机 器 人 。 该 图 形 模型 表征 问题 的 

时 序 形态 ， 因 此 属于 链 式 网 络 。 有 关 这 类 模型 的 更 多 
讨论 ， 请 参考 文献 [4.31]. 


图 4 12 表征 机 器 人 定位 的 图 形 模型 示例 


贝 叶 斯 网 络 的 结构 可 代表 变量 之 间 的 各 种 独立 关 
系 。 人 研究 这 些 独 立 关 系 可 以 设计 出 有 效 的 推理 算法 。 
尤其 ,无 环 图 即便 是 采用 无 向 形式 〈 称 为 多 树 ) 时 
也 兼容 线性 推理 算法 。 更 通用 的 图 可 用 多 种 循环 和 迭 代 
方法 求解 。 特 别 是 ， 如 果 网 络 中 的 分 布 是 连续 形式 ， 
连续 关键 采样 的 变 体 可 用 近似 方法 来 求解 问题 “”; 。 


4.3.3 鲁 棒 估 计 方 法 


在 前 面 的 论述 中 ， 我 们 一 般 性 地 假设 所 有 的 数据 
都 是 “好 的 "， 意 味 着 数据 即便 是 因 干 护 而 损坏 ， 但 
最 终 仍然 携带 当前 问题 的 信息 。 然 而 ， 在 许多 情况 
下 ， 数 据 可 能 含有 离 群 值 ， 要 么 跟 典 型 数据 相 比 损坏 
严重 ， 要 入 完 全 就 是 可 疑 的 数据 ， 例 如 ， 在 我 们 的 地 
图 绘制 应 用 中 ， 我 们 可 能 偶尔 会 收 到 经 过 了 多 次 反射 
回来 的 范围 数据 。 因 此 ， 当 扫描 一 道 直 墙 时 ， 大 部 分 
的 点 都 会 沿 一 条 直线 分 布 ， 但 偶尔 会 有 距离 值 完全 不 
一 臻 的 数据 点 。 

问题 在 于 ， 许 多 常见 的 估计 方法 对 数据 离 群 值 非 
党 敏感 。 考 虑 一 个 简单 例子 ， 通 过 一 系列 观测 值 X, , 
B, e, 天 ,来 估计 标量 x。 我 们 有 以 下 的 估计 

5x 
不 失 一 般 性 ,假设 X AER ell RT DL ETSI E 
达 式 


(4.31) 


N-1 
R= D X/N + ra (4. 32) 


ANMEE I, GWE XA, x 可 以 取 任何 值 。 简 而 言 
之 ， 单 个 离 群 数据 能 够 产生 任意 差 的 估计 。 更 一 般 地 
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说 ， 任 何 最 小 二 乘 问题 的 解 ， 例 如 从 激光 距离 数据 估计 
一 条 直线 ， 可 用 一 般 形式 +=My 表示 。 基 于 以 上 相同 的 
理由 ， 不 难得 出 任何 最 小 二 乘 解 都 易 受 离 群 值 的 影响 。 

鲁 棒 统计 领域 研究 的 是 当前 数据 被 离 群 值 污染 时 
的 估计 或 者 决策 问题 。 鲁 棒 统 计 中 有 两 个 重要 的 概 
念 ， 届 服 点 和 影响 函数 。 届 服 点 是 在 估计 过 程 中 估计 
子 不 产生 任意 大 误差 所 能 承受 的 离 群 值 (数据 具备 
任意 大 误差 ) 的 比例 。 我 们 认为 最 小 二 乘 方法 的 屈 
服 点 为 0% ， 因 为 单个 观测 的 干扰 可 导致 估计 的 偏差 
足够 远 。 相 比 而 然 ， 我 们 也 可 以 取 数 据 的 中 间 值 来 计 
算 佑 计 ， 这样 届 服 点 为 50% 即使 一 半 的 数据 为 
离 群 值 ， 仍 然 可 以 产生 有 意义 的 结果 。 

届 服 点 确定 可 以 承受 的 离 群 值 数量 ， 而 影响 函数 
确定 一 个 离 群 值 对 估计 的 影响 程度 。 最 小 二 乘 情况 
下 ， 影 响 函数 为 线性 函数 。 创 建新 的 更 鲁 棒 性 估计 子 
的 一 种 方法 是 M 估计 "1 。 为 产生 M 估计 ， 我 们 考 
虑 下 列 最 小 化 问题 


N 
min > p($, yi) 
全 i=l 
请 注意 ， X pla, b)-(a-b)' S fg; — Fe fit, 


然而 ， 我 们 可 以 选择 其 他 对 离 群 值 阻 抗 更 好 的 函数 。 
图 4. 13 给 出 了 3 个 常见 范例 。 


(4. 33) 


b) 


图 413 3 个 常见 范例 
a) 三 种 常见 的 鲁 棒 M 估计 函数 、 平 方 函数 、 绝 对 值 和 
图 基 双 权重 函数 b) 相应 的 影响 函数 


请 注意 ， 一 般 说 来 , 式 (4.33) 的 优化 是 非 线 
性 的 ， 通 常 不 存在 闭合 形式 解 。 有 趣 的 是 ， 用 重复 再 
加 权 最 小 平方 法 (IRLS) 来 求解 该 问题 通常 是 可 能 
Ay IRLS 的 原理 很 简单 。 之 前 在 式 (4.7) 中 
我 们 引入 了 一 个 权重 矩阵 WW。 假 设 我 们 可 以 通过 某 种 
方式 知道 哪些 数据 点 是 离 群 值 。 在 这 种 情况 下 ， 我 们 
可 以 简单 地 将 这 些 点 的 权重 设 为 零 ， 得 到 的 结果 将 是 
XR (优良 ) 数据 的 最 小 二 乘 估计 。 

在 IRLS 中 ,我 们 交替 假设 离 群 值 (通过 再 加 
BO) 和 求解 来 得 到 结果 (通过 最 小 二 乘 ) 。 通 常 ， 点 
的 权重 依赖 于 估计 的 残留 误差 。 假 设 我 们 计算 

rzy-FX 


(4. 34) 


S ply) = dp/dx |;， 然 后 我 们 可 以 设 W; = by) 77,0 
可 以 证 明 ， 在 许多 情况 下 ， 这 种 形式 的 加 权 可 以 收 
SX. E 4.14 给 出 了 一 个 利用 IRLS 技术 进行 视频 追踪 
的 范例 。 


图 4 14 用 IRLS 实现 的 M 估计 来 进行 视频 追踪 的 范例 “3] 
a) 单 帧 视频 的 人 脸 追踪 结果 (黑色 边框 对 应 没有 别 除 
离 群 值 的 追踪 算法 ， 和 白色 边框 则 对 应 于 剔除 了 异常 值 的 
Tk.) b) 白色 边框 内 区 域 的 放大 图 c) 相应 的 权 

重 和 矩阵 表示 (黑色 的 区 域 代表 异常 值 ) 


另外 一 种 处 理 离 群 值 的 常用 方法 是 基于 表决 的 
方法 ， 即 选择 一 系列 数据 然后 对 结果 进行 表决 。 我 
们 讨论 两 种 常用 的 方法 : RANSACE* 和 最 小 均 方 
(LMedS) 4?! 。 

在 两 种 情况 下 ， 我 们 都 从 这 样 的 一 个 概念 开始 ， 
即 在 所 有 数据 (包括 离 群 值 ) 中， 存在 一 个 与 好 的 
数据 相 一 致 的 估计 。 问 题 演 变 为 如 何 选 出 该 估计 。 考 
虑 我 们 之 前 的 问题 ， 即 从 激光 数据 估计 一 条 直线 ， 并 
假设 我 们 拥有 100 个 激光 点 。 我 们 真正 需要 的 是 正确 
选 出 两 个 点 ， 匹 配 出 一 条 直线 ， 然 后 记录 其 他 点 有 多 
少 是 与 该 直线 相 一 致 的 。 如 果 我 们 (保守 地 ) 估计 
3/4 的 数据 是 好 的 ， 那 么 选 出 两 个 好 的 点 的 几率 是 
9/16， 或 等 效 于 有 一 个 或 两 个 点 为 离 群 值 的 几率 是 
7/16。 如 果 我 们 重复 该 步骤 数 次 (例如 10 次 )， 那 
么 我 们 所 有 的 选择 均 为 差 的 几率 是 (7/16)”= 
0.025% 。 换 种 说 法 ， 有 99. 975% 的 几率 我 们 已 经 选 
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择 了 一 个 好 的 点 对 。 

我 们 如 何 决 定 接受 一 个 采样 ? 在 RANSAC 中 ， 
我 们 对 在 给 定 的 距离 临界 值 内 与 估计 相 一 致 的 采样 数 
目 进行 计数 来 进行 表决 。 例 如 ， 我 们 选择 那些 距 我 们 
估计 出 的 直线 某 一 固定 距离 以 内 的 点 。 在 LMedS 中 ， 
我 们 则 计算 所 有 采样 点 与 直线 之 间 的 距离 中 值 。 然 后 
我 们 选取 具有 最 小 中 值 的 估计 。 

不 难看 出 LMedS 有 一 个 屈服 点 是 数据 取 值 的 
50% 。 男 一 方面 ，RANSAC 的 一 个 屈服 点 能 够 更 大 ， 
但 是 这 需要 选择 临界 值 。RANSAC 还 具备 这 样 一 项 优 
势 ， 一 旦 确定 了 非 离 群 值 ， 可 以 从 非 离 群 值 计算 最 小 
均 方 估计 ， 因 此 可 以 降低 估计 中 的 干扰 。 

RANSAC 和 LMedS 也 可 以 为 鲁 棒 和 迭代 方法 ， 例 
如 IRLS， 提 供 好 的 初始 解 。 


数据 关联 技术 


上 一 节 考 虑 的 情况 是 在 观测 值 与 待 佑 计量 之 间 存 
在 某 一 已 知 的 关联 。 然 而 ， 正 如 在 我 们 最 初 的 移动 机 
器 人 地 图 问题 中 所 说 明 的 ， 有 的 情况 下 除了 佑 计 外 ， 
我 们 需要 同时 计算 这 个 关联 本 身 。 在 这 种 情况 下 ， 估 
计 中 的 一 个 必要 步骤 就 是 数据 关联 问题 : 得 到 观测 数 
据 与 待 估计 量 之 间 的 相关 性 。 

有 很 多 关于 这 个 问题 的 文献 ; 这 里 我 们 主要 讨论 
几 种 广泛 应 用 的 特定 方法 。 我 们 的 讨论 将 分 为 通常 用 
于 时 序数 据 滤波 的 散 (或 称 顺序 ) 关联 方法 ， 和 有 
完整 的 数据 可 供 处 理 时 使 用 的 非 散 (或 称 为 批 ) 关 
联 方法 。 后 者 常用 数据 分 组 方法 来 处 理 。 

在 这 两 种 情况 下 ， 我 们 可 以 向 数据 源 引 入 不 确 
定 度 来 扩展 之 前 的 模型 和 定义 。 为 此 ， 我 们 将 在 数 
据 上 用 上 标 来 表示 观测 模型 。 因 此 ， 我 们 的 观测 模 
型 变 成 


4.3.4 


k 


xha =g) tw, (4.35) 
yi =f (as) +n; (4.36) 

JI, Ab k 2 1--- M, 

1. 成 批 数据 分 组 

按照 之 前 进行 点 估计 的 相同 步 又 ， 我 们 首先 考虑 
对 数据 完全 不 做 任何 统计 假设 ， 系 统 动力 学 也 未 知 的 
情况 。 因 此 ， 只 有 观测 值 y, . y. cn. yu ES RA 
参数 为 x, ，x;，…，xw (我 们 暂时 认为 为 已 知 ) 。 
我 们 的 目标 是 计算 关联 映射 +， 使 得 当 且 仪 当 模型 参 
Ai xt PRI yE, 7(]) =k. 

2. 天 均值 聚 类 

用 于 分 组 和 数据 关联 的 上 均值 算法 简单 ， 且 广 为 
接受 ， 因 此 是 我 们 讨论 的 一 个 好 的 起 点 。 这 里 ， 我 们 
假设 Ax) =x， 也 就 是 说 ， 提 供给 我 们 的 是 当前 状态 


h 


向 量 的 含 干 扰 观 测 值 。 然 后 ， 如 下 应 用 上 均值 算法 : 
1) 选取 NN 个 数据 簇 的 中 心 11s 
2) 对 于 每 一 观测 值 y， 将 它 与 最 临近 的 簇 中 心 
相关 联 ， 也 就 是 说 , 令 7()) =i, 对 某 些 距离 函数 d 
(通常 为 欧 几 里 德 距离 ) 满足 
d(x", yj) =mind(x", yj) (4. 37) 
3) 估计 与 每 一 复 中 心 相 关联 的 观测 的 均值 
ï= 》y (4.38) 


Jj, 7()-i 


4) 重复 步 又 2) 813), 

在 许多 初始 化 良好 的 情况 下 , 上 均值 工作 得 很 
好 。 但 是 ， 该 方法 不 能 生成 合适 的 复 ， 也 不 能 保证 能 
收敛 得 到 解 。 因 此 ， 常 见 的 做 法 是 ， 以 不 同 的 初始 条 
件 重 复 该 算法 几 次 再 挑 取 最 优 的 结果 。 也 请 注意 ， 通 
过 定义 


d(2 ,y)) = ||F& -yl (4.39) 

在 式 (4.3) 中 引入 F, HAHAA Ig Fe hit F 
替换 式 (4.38) 可 以 直接 扩展 线性 观测 模型 。 进 一 
步 说 ， 如 果 我 们 有 观测 数据 的 统计 模型 ， 那 么 我 们 可 
以 利用 之 前 定义 的 似 然 函数 ,定义 d(* ， y) = 
p(y; |) , AER (4.38). 中 的 MLE. 

均值 算法 的 一 个 局 限 是 即使 我 们 已 知 统计 模 
型 ， 也 不 保证 一 定 收敛 。 但 是 ， 该 方法 的 一 个 变 体 ， 
称 为 期 望 最 大 化 ， 可 被 证 明 收 敛 。 

3. 数据 关联 的 期 望 最 大 化 与 模拟 

期 望 最 大 化 (EM) 算法 "是 一 种 用 来 处 理 数 
据 丢失 的 通用 统计 技术 。 在 前 面 的 讨论 中 ， 给 定 未 
知 参 数 集 ， 我 们 用 最 大 似 然 估计 来 最 大 化 观测 数据 
的 条 件 概率 。 但 是 ， 使 用 MLE 时 我 们 假设 数据 完全 
已 知 。 特 别 是 ， 我们 知道 数据 成 分 与 模型 之 间 的 
关联 。 

现在 让 我 们 假设 部 分 数据 丢失 。 为 此 ， 分别 定义 
Yo AY, 为 观测 数据 和 非 观测 数据 。 然 后 我 们 可 以 写 

pO Yu lx) =P% | Yo.x)P(Yolx) (4.40) 
假设 现在 我 们 给 定 猜测 *， 并 有 关于 未 知 数据 LBS — 
个 分 布 (下 面 马 上 将 会 讨论 这 一 点 )。 我 们 可 以 计算 
对 数 似 然 函 数 的 期 望 值 (之 前 提 到 过 最 大 化 对 数 似 
然 值 等 同 于 最 大 化 似 然 值 ) 为 

Q(x,x) 2 Ey, [logo Mo, Yo 1x) [Mo, 5]. (4.41) 
注意 我 们 区 分 * 为 固定 量 ， 通 常 需要 定义 其 在 未 知 数 
据 上 的 分 布 ， 而 未 知 量 x AT ICIP KR 

理想 情况 下 ， 我 们 接 下 来 可 以 选择 x 的 数值 使 得 
0 最 大 。 因 此， 根据 迭代 法 则 ， 我 们 可 以 选择 一 个 新 
的 值 
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X, = arg maxQ(x,X, ) (4.42) 
可 以 证 明 ， 上 述 循环 将 会 收敛 于 目标 函数 0 的 局 部 
最 大 值 。 但 是 值得 注意 的 一 点 是 ， 不 能 保证 该 最 大 值 
为 全 局 最 大 值 。 
如 何 将 其 与 数据 分 组 相关 联 ? 我 们 考虑 观测 数据 
即 为 已 观测 到 的 数据 。 设 未 观测 到 的 数据 为 关联 值 
mj), fal, 2, --M 确定 观测 数据 所 来 自 的 模型 。 
请 注意 它 是 一 个 离散 随机 变量 。 进 一 步 假设 有 N 个 
数据 簇 服从 高 斯 分 布 ， 均 值 为 x;， 方 差 为 A;。 设 一 
个 特定 数据 项 y, 来 自 于 第 i 艇 的 无 条 件 概 率 为 a R 
知 参 数 为 86= {x vy， xy, ÅA 4, =, Ay, 
Ql，Q，…，Qw|。 我 们 用 -和 + 来 分 别 表示 先 验 参 
数 估计 和 更 新 的 参数 估计 。 基 于 简明 的 目的 ， 我们 也 
EX w,,=p(m, =ily,, 0), FFA Pip + 来 表示 更 新 
的 参数 估计 。 然 后 ， 经 过 一 系列 计算 推导 ， 数 据 分 组 
的 EM 算法 变 为 
E- 步 又 : 


pCy; |a) =1,0)a,; 


YS p(y 2G) =i,0) a, (4. 43) 
M-2ERR 
= Xm Daws (4. 44) 
= 20) wy $9; (4.45) 
" by v, / 2, De, (4. 46) 


从 上 述 推导 可 以 看 出 EM 算法 产生 的 是 一 种 软 分 组 ， 
相反 ,均值 产生 的 是 观测 值 从 属于 哪 一 个 数据 簇 的 
确定 性 决策 (用 wi ,表示 )。 实 际 上 ,估计 的 结果 是 
合 模型 的 最 大 似 然 估计 ， 可 如 下 表示 


VENE CU Ld 
此 处 N(. ) 代表 一 密度 函数 。 图 4. 15 给 出 
TE R 
结果 。 


高 斯 混合 


(4.47) 


图 4.15a-d 期 望 最 大 化 分 组 示例 (图例 为 第 1, 58 2, 第 5 和 第 10 次 循环 的 结果 ) 


4. 递归 滤波 
在 上 述 的 批 处 理 方法 中 ， 我 们 预先 并 不 知道 状态 
参数 的 信息 。 进 行 递归 滤波 时 ， 有 利 的 是 我 们 在 时 刻 


cao he Oe i NM OR 
问题 是 确定 映射 了: e NI dL 
duni eR 


yi, dele 
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情况 下 ， 包 含 一 个 离 群 值 过 程 以 处 理 来 自 于 未 知 模型 
的 数据 是 有 益 的 。 为 此 ， 我 们 可 以 在 函数 范围 内 包含 
零 值 ， 并 把 零 映 射 作为 离 群 值 。 

5. 最 近邻 关联 

类 似 于 下 均值 分 组 ， 产 生 数 据 关 联 的 一 种 简单 方 
式 是 如 下 计算 数据 关联 值 

m(i) =arg mind( PIY, °) (4.48) 

然而 ， 最 近邻 方法 并 不 考虑 我 们 关于 传感器 数据 或 者 


测 和 相关 性 。 

一 旦 确定 了 物理 模型 ,通常 有 一 个 传 感 避 标定 的 
步 又。 该 步骤 一 般 特 定 于 所 使 用 的 传 感 顺 ， 例 如 ， 透 
视 相 机 系统 的 图 像 几 何 要 求 识 别 两 个 缩放 参数 (XE 
体 图 像 尺度 ) 和 光学 中 心 (两 个 额外 参数 ) 的 位 置 。 
通常 还 有 镜头 失真 参数 。 这 些 参数 只 能 通过 仔细 的 标 
定 程序 才能 确定 “1。 

一 旦 标定 好 的 物理 传感器 模型 可 用 ， 确 定 一 个 误 


估计 的 已 知 信息 。 也 就 是 说 ， 我 们 可 能 对 模型 ; 有 一 
个 非常 好 的 估计 ， 而 对 另外 的 模型 / 有 一 个 非常 差 的 
估计 。 如 果 传 感 器 对 两 者 等 距离 观测 ， 掷 硬币 决定 会 
有 意义 吗 ? 观测 来 自 于 模型 j (其 方差 较 大 ) 比 模型 
i (方差 较 小 ) 更 有 可 能 。 

考虑 以 上 因素 的 一 种 常用 措施 是 马 哈 拉 诺 比 斯 距 
离 ”1。 其 原理 是 根据 方差 来 对 每 个 数值 进行 加 
权 ， 即 

m.) =i 272) A +4) Oi y)" 

(4.49) 

因此 ， 距 离 按 与 不 确定 度 成 反比 缩放 。 在 上 述 情 况 
下 ,具有 较 高 方差 的 观测 将 产生 较 小 的 距离 ， 与 我 们 
设想 的 一 致 。 
即便 使 用 这 种 加 权 方 法 ， 我 们 在 数据 关联 中 仍然 
可 能 犯错 。 从 估计 的 观点 来 看 ， 这 将 在 估计 过 程 中 引 
入 离 群 值 ， 如 上 所 述 ， 并 可 能 导致 很 糟 的 结果 。 另 外 
一 种 方法 ， 类 似 于 IRLS， 基 于 与 模型 之 间 的 距离 来 
对 数据 加 权 。 这 就 很 自然 地 导致 了 数据 关联 滤波 的 概 
念 。 有 关 这 些 方法 的 更 广泛 讨论 ,我们 推荐 读者 阅读 
参考 文献 [4.18]. 


4.3.5 传感器 模拟 


至 此 ， 我 们 已 经 介绍 了 几 种 传 感 模式 ， 也 讨论 了 
几 种 佑 计 方 法 。 但 是 ， 后 者 通常 依赖 于 具备 前 者 的 统 
计 模 型 。 因 此 ， 有 关 传 感 器 模拟 的 简短 讨论 可 以 令 传 
感 与 估计 章节 更 加 完整 。 

设计 一 个 传感器 模型 涉及 四 个 主要 部 分 : 中 创立 
一 个 物理 模型 ， 思 确定 传感器 标定 ; OME TRE 
型 ; 由 识 别 失 效 条 件 。 

物理 模型 是 待 测量 (x) 与 可 用 数据 (y) 之 间 
ARR f. 在 许多 情况 下 ， 该 关系 是 很 明显 的 ， 例 
如 ， 激 光 传 感 器 与 环境 中 某 表面 之 间 的 距离 。 在 其 
他 情况 下 ， 该 关系 可 能 没有 如 此 明显 ， 例 如 ， 多 幅 
相机 图 像 中 的 亮度 与 相机 至 观测 点 之 间 的 距离 这 两 
者 相关 联 的 正确 模型 是 怎样 的 ? 在 某 些 情况 下 ， 包 
含 计 算 过 程 是 必要 的 ， 例 如 传感器 模型 中 的 特征 检 


差 模型 通常 包含 统计 参数 的 识别 。 理 论 上 ， 第 一 步 是 
确定 一 个 误差 的 经 验 分 布 。 但 是 ， 这 通常 是 很 困难 
的 ， 因 为 它 需 要 知道 未 知 参数 的 精确 的 地 面 真 值 。 这 
通常 需要 开发 一 个 可 模拟 所 期 望 的 传 感 情况 的 实验 
装置 。 

给 定 这 样 的 一 个 经 验 分 布 ， 还 有 几 个 重要 的 问 
题 ,包括 : 中 观测 在 统计 上 独立 吗 ? @ 误 差分 布 是 否 
单 峰 ? @) 经 验 误差 的 关键 要 素 能 和 否 用 常见 的 统计 量 ， 
例如 数据 方差 ,来 获取 ? 关于 该 主题 的 更 多 信息 ， 我 
们 推荐 读者 阅读 统计 与 数据 模拟 方面 的 书籍 (9,55 
考 文献 [4.38] ) 。 

最 后 ， 理 解 何 时 传感器 能 够 或 不 能 够 提供 可 靠 的 
数据 是 很 重要 的 ， 例 如 ， 激 光 传 感 器 在 黑暗 的 表面 上 
不 如 在 明亮 表面 上 精确 ， 光 照 太 亮 或 者 太 暗 相机 不 能 
生成 有 意义 的 数据 ， 等 等 。 有 时 ， 有 简单 迹象 可 判断 
这 些 情况 的 存在 ， 例 如 ， 察 看 相机 图 像 的 强度 直方 图 
能 够 快速 断定 当前 条 件 是 否 适合 处 理 。 有 些 情况 下 ， 
只 能 在 背景 下 才 可 能 检测 到 这 些 状况 ， 例 如， 两 个 
E 离 传感器 检测 到 的 与 某 表 面 的 距离 不 一 致 。 有 时 
失效 只 能 在 回溯 中 才能 诊断 出 来 ， 例 如 一 个 三 维 表 
面 模型 建立 后 ， 很 明显 ， 一 个 假设 的 表面 被 另 一 个 
所 阻隔 ， 则 必定 有 多 重 反 射 存 在 。 在 一 个 真正 鲁 棒 
的 传 感 系统 中 ， 应 该 用 所 有 可 能 的 方法 来 验证 传 感 
IRRE, 


4.3.6 其 他 不 确定 性 管理 方法 


鉴于 篇 幅 所 限 ， 我 们 的 讨论 只 局 限于 最 常用 的 传 
感 和 估计 方法 。 值 得 注意 的 是 已 经 有 许多 其 他 的 替代 
性 不 确定 性 管理 方法 被 提出 来 并 成 功 应 用 。 

例如 ， 如 果 已 知 传 感 误差 有 界 ， 那 么 基于 约束 的 
方法 对 点 估计 很 有 效 *”" 。 或 者 ， 如 果 只 有 部 分 概 
率 模 型 能 被 识别 ， 可 用 丹 普 斯 特 - 谢 菲 方法 来 做 
DURUM. 

模糊 逻辑 允许 采用 集合 梯度 形成 员 函 数 。 模 糊 集 
合理 论 使 得 部 分 成 员 成 为 可 能 。 例 如 ， 在 数据 分 类 
中 ， 在 某 两 个 范畴 例如 “平均 ”与 “高 ”中 选择 可 
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能 很 困难 ， 但 是 用 逐步 切换 则 行 得 通 。 如 参考 文献 


[4.45, 46] 证 明了 多 条 激光 距离 扫描 能 够 合成 一 个 


[4.42] 所 述 ， 这 类 方法 已 用 于 DAMN 结构 的 情况 评 
佑 与 导航 。 


4.4 表示 方法 


传感器 数据 可 直接 用 于 控制 ， 但 也 用 于 估计 机 器 
人 和 (或 ) 环境 的 状态 。 状 态 的 定义 及 适合 的 佑 计 
方法 与 当前 应 用 所 采用 的 表示 方法 紧密 相关 。 

有 很 多 种 可 能 的 环境 表示 方法 ， 包 括 最 典型 的 几 
何 元 素 ， 例 如 点 、 曲 线 、 表 面 和 容积 。 机 器 人 的 一 个 
基本 概念 是 刚体 的 姿势 。 机 器 人 或 者 实体 在 环境 中 的 
姿势 由 相对 于 参考 框架 的 位 置 与 方向 来 表征 。 

一 般 来 说 ， 用 参数 对 (R, T) 来 代表 姿势 。 这 
E, R 是 物体 的 方向 ， 用 相对 于 参考 框架 的 旋转 矩阵 
来 表示 。 类 似 地 ,7 表示 物体 相对 于 参考 框架 的 平 
移 。 参 考 框架 之 间 的 变换 有 多 种 潜在 的 表达 方式 ， 在 
运动 学 章节 (第 1 章 ) 和 参考 文献 [4.43] 中 有 详 
细 表 述 。 

传感器 数据 在 本 地 传感器 参考 框架 中 采集 ， 例 
如 ， 声 纳 转换 器 、 雷 达 扫 描 仪 和 立体 图 像 系 统 都 用 来 
测量 环境 中 的 表面 相对 于 传感器 自身 框架 的 距离 。 但 
是 ， 如 果 目 标 是 将 这 类 信息 组 合成 常见 的 环境 模型 ， 
数据 必须 转换 成 以 机 器 人 为 中 心 的 参考 框架 ， 或 者 也 
可 转换 成 到 一 个 固定 世界 (惯性) 参考 框架 中 。 特 
别 地 ， 志 界 中 心 参考 框架 令 机 器 人 运动 和 通信 可 以 简 
单传 递 给 其 他 机 器 人 和 (或 ) 用 户 。 

为 方便 讨论 ， 绝 大 多 数 集成 传感器 数据 的 表示 方 
法 可 以 分 为 四 个 通用 模型 类 别 : 中 原始 传感器 数据 模 
型 ，@) 基 于 网 格 的 模型 ， 急 基于 特征 的 模型 ， OFS 
或 者 图 形 模 型 。 

很 自然 地 ， 也 可 以 组 合 这 四 个 类 别 的 元 素来 获得 
混合 环境 模型 。 


4.4.1 原始 传感器 表征 


对 于 简单 反馈 控制 “” ， 常 见 做 法 是 将 原始 传 感 
器 数据 直接 整合 至 控制 系统 ， 因 为 在 许多 情况 下 ， 控 
制 本 身 并 不 需要 世界 模型 。 例 如 ， 常 常 这 样 应 用 本 体 
感受 传 感 : 基本 的 轨迹 控制 直接 利用 关节 编码 器 的 信 
息 ， 而 力 控制 直接 利用 来 自力 传感器 的 受 力 或 转 矩 信 
息 运 作 。 

外 感受 传 感 中 原始 传 感 避 模型 没有 这 样 常用 ， 但 


点 数据 构建 地 图 。 这 种 方法 对 激光 测 距 仪 特别 常用 ， 
用 扫描 校准 来 生成 基于 点 的 世界 模型 。 参考 文 献 


a 


环境 模型 。 用 公式 表达 ， 在 时 间 1 的 一 个 环境 扫描 可 
表示 成 点 集 
P, = lp; =(p;,9;) |ie1--N] (4. 50) 

然后 通过 标准 的 SE (3) 变换 来 校准 两 个 不 同 的 扫描 
PP, o WJH ICP 算法 中 来 估计 上 述 变 换 ， 假设 
T 为 两 个 点 集 之 间 变 换 的 初始 估计 ， 并 且 
lp, -pa ARE 玫 中 的 一 点 与 点 集 P 中 的 另外 
一 点 之 间 的 欧 几 里 德 距 离 。 如 果 进 一 步 令 CP 为 确 
定 一 个 点 集中 与 另外 一 个 点 集 最 近 的 点 的 函数 ， 
S @ 为 两 个 点 集 之 间 的 点 对 集合 。 通 过 下 述 算法 
的 迭代 : 

1) WHE = UN, lp, CRIT" (p, Pa) ls 

2) 估计 7 和 ， 使 得 点 集 @ 中 的 点 之 间 LSQ 误差 
最 小 ， 直 到 误差 收敛 。 
可 以 找到 扫描 校准 的 估计 ， 并 构建 环境 的 合成 模型 。 

模型 易于 构建 并 适合 单一 模 态 传感器 数据 的 集 
成 。 通 常 模型 并 不 包含 不 确定 度 信息 ， 且 随 着 模型 增 
K, AREO LAD 将 变 成 一 个 问题 。 


4.4.2 基于 网 格 的 表示 方法 


在 一 个 基于 网 格 的 表示 方法 中 ， 环 境 被 细 分 为 
许多 单元 。 单 元 能 容纳 环境 特征 ， 例 如 温度 、 障 得 
物 、 力 分 布 等 。 网 格 的 维度 通常 为 二 或 者 三 ， 随 具 
体 的 应 用 而 定 。 网 格 可 以 是 均匀 细 分 或 者 是 利用 四 
叉 树 或 人 又 树 的 树 状 划分 “” 。 基 于 树 的 方法 特别 
适合 处 理 非 均 匀 及 大 尺度 数据 集 。 在 一 个 网 格 模型 
中 ， 每 一 单元 含有 一 个 沿 参数 集 分 布 的 概率 。 例 如 ， 
用 网 格 模型 来 表示 物理 环境 时 ， 单 元 规定 为 占用 或 
者 空间 ， 并 有 概率 P (表示 占用 率 )。 一 开始 无 已 知 
言 息 ， 故 网 格 被 初始 化 为 忆 (占用 ) 20.5 来 表示 其 
状态 未 知 。 进 一 步 假定 传感器 模型 PCR |S, ) 可 用 ， 
即 ， 对 给 定 的 传感器 和 位 置 检 测 到 物体 的 概率 。 
通过 贝 叶 斯 理论 "1 ， 能 够 根据 下 式 来 更 新 网 格 
Bin. 


P(R| $5; 2 O)p;t 

~ P(R|S, =O)p,;t +P(R|S, =F) (1 - pyt) 
此 处 ， 每 当 获 取 到 新 数据 ， 就 通过 网 格 模型 计 
T psc 
基于 网 格 的 模型 已 经 广泛 用 于 移动 机 器 人 ”| 
和 广泛 应 用 图 像 容 积 的 医疗 图 像 领 域 "” 。 容 积 模型 
可 以 相对 很 大 ， 例如， 解析 度 为 毫米 级 的 人 脑 网 格 模 
型 需要 4GB 的 存储 空间 ， 因 此 需要 相当 多 的 计算 资 
源 来 进行 维护 。 


py(t+1) 
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4.4.3 离散 特征 表示 


原始 传感器 表示 和 基于 网 格 的 模型 都 包含 传感器 
数据 的 最 小 抽象 。 在 许多 情况 下 ， 我 们 感 兴趣 的 是 从 
传感器 数据 提取 特征 以 降低 存储 的 需求 ， 只 保留 平台 
运动 过 程 中 始终 不 变 的 数据 或 外 部 对 象 。 特 征 的 范围 
包括 大 部 分 标准 几何 实体 例如 点 (p), £X (1) ， 面 
(N, p), HAAG (p(s)) 和 更 通用 的 表面 。 为 估计 外 
部 环境 的 属性 ， 混 合 模型 是 有 必要 的 ， 即 把 特征 集合 
整合 到 一 个 统一 的 状态 模型 中 。 

通常 在 三 维 空间 只 (3) 表征 一 个 点 。 传 感 咒 具 
有 相应 的 干扰 ， 因 此 ， 在 大 多 数 情况 下 ， 点 具有 相 
应 的 不 确定 度 ， 一 般 用 均值 为 人 4， 标 准 偏差 为 o 的 
高 斯 变量 来 模拟 。 用 一 阶 和 二 阶 矩 可 求 得 统计 量 的 
估计 。 

表征 直线 特征 更 加 困难 。 数 学 上 的 直线 可 以 用 向 
EX (p, t) 来 表示 ， 即 直线 上 的 一 点 和 切 向 量 。 在 
许多 实际 的 应 用 中 ， 直 线 为 有 限 长 度 ， 故 有 必要 对 直 
线 的 长 度 进 行 编码 ， 这 可 以 用 端点 、 起 点 、 切 线 和 长 
度 来 实现 。 在 某 些 情况 下 ， 直 线 模型 的 元 余 表征 更 加 
有 利于 简化 更 新 和 匹配 。 端 点 不 确定 度 与 其 他 直线 参 
数 之 间 的 关系 可 以 用 分 析 方 法 加 以 推导 ， 如 文献 
[4.51] 所 述 。 直 线 参数 的 估计 通常 基于 之 前 描述 的 
RANSAC Wik, iLL RR 来 实现 ， 霍 夫 变换 
是 另外 一 种 基于 表决 的 方法 。 

对 于 更 复杂 的 特征 模型 ， 例 如 曲线 或 者 表面 ， 
有 必要 利用 有 助 于 鲁 棒 特征 分 离 和 相关 不 确定 度 佑 
计 的 检测 方法 。 文 献 [4. 36] 中 有 该 类 方法 的 完整 
描述 。 


4.4.4 符号 /基于 图 的 模型 


第 4.4.1~4.4.3 节 所 描述 的 所 有 代表 方法 本 质 
上 都 是 参数 型 ， 相 关 的 语义 有 限 。 用 于 识别 结构 ， 空 
[8], 位置 和 物体 的 方法 近来 有 很 大 进展 ， 这 要 特别 归 
功 于 统计 学 习 理 论 的 进展 *"”” 。 因 此 ， 如 今 有 许多 
不 同方 法 用 于 识别 传感器 数据 中 的 复杂 结构 ， 例 如 标 
志 物 、 路 表面 、 体 结构 等 。 如 有 识别 的 构造 可 用 ， 则 
可 利用 前 面 讨论 过 的 图 形 模型 来 表征 环境 。 一 般 ， 一 
张 图 由 一 组 节点 N 和 一 组 连接 节点 的 边 E 所 组 成 。 
节点 和 边 都 可 拥有 相关 的 属性 ， 例 如 标签 和 距离 。 
结构 的 一 个 例子 是 环境 拓扑 图 ， 如 图 4.16 所 示 。 
的 表征 也 可 以 是 环境 的 语义 模型 ( 物体 和 地 点 ) 
者 是 竺 组装 的 物体 成 分 的 表征 。 


图 4 16 空间 环境 的 拓扑 图 


关于 模型 更 新 ， 基 于 语义 /图 的 表征 可 以 利用 由 
Pearl 所 表述 的 贝 叶 斯 推理 方面 的 最 新 进展 *”， 并 
可 在 文献 [4.54] 中 找到 应 用 实例 。 


45 结论 与 扩展 阅读 


传 感 和 估计 仍 是 机 器 人 研究 的 挑战 性 和 活跃 领 
域 。 传 感 的 几 个 领域 ， 例 如 计算 机 视觉 和 医学 图 像 本 
身 是 很 大 而 多 样 的 研究 领域 。 同 时 ， 估 计 中 新 的 基础 
及 应 用 技术 仍 将 被 持续 开发 。 实 际 上 ， 可 以 说 感觉 仍 
将 是 机 器 人 研究 的 最 具 挑 战 性 领域 之 一 。 
基于 这 样 的 背景 ， 单 个 章节 不 可 能 涵盖 基于 传 感 
器 的 机 器 人 发 展 中 的 所 有 有 用 材料 。 但 是 ， 本 章 中 所 
论述 的 方法 代表 机 器 人 中 的 最 常用 技术 。 特 别 是 ， 线 
性 技术 例如 凯 尔 曼 滤 波 仍然 是 感觉 机 器 人 的 主干 。 本 
手册 的 第 3 篇 更 深入 地 涵盖 了 传 感 与 估计 中 的 数 个 关 
键 主题 。 

如 果 读 者 希望 了 解 更 多 ,在 现代 传感器 手册 中 
可 以 找到 有 关 传 感 器 设计 、 物 理学 和 使 用 不 同 传 感 
器 的 一 般 讨论 * 站 。 在 参考 文献 [4.55] 中 可 找到 
关于 移动 机 器 人 传感器 的 讨论 ， 虽然 自 该 书 于 十 余 
年 前 出 版 后 取得 了 重大 进展 。 参 考 文献 [4.56] 和 
[4.57] 中 详细 描述 了 利用 计算 机 视觉 进行 传 感 与 
估计 。 

许多 的 优秀 教科 书 都 涵盖 了 基本 的 估计 理论 。 参 
考 文献 [4.18] 和 [4.58] 中 深入 涵盖 了 检测 和 线 
性 估计 理论 的 大 部 分 内 容 。 参考 文献 [4.10]. 
[4.11] 及 其 最 新 版 本 [4.36] 中 涵盖 了 通用 统计 学 
估计 。 参 考 文献 [4.19, 35] 详细 描述 了 重 棱 方法 。 
参考 文献 [4.31] 也 深入 涵盖 了 移动 机 器 人 的 估计 
方法 。 
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Lydia E. Kavak, 


本 草 首 先 在 S. 1 节 提 出 了 几何 路 径 规 划 的 公 


式 ， 接 着 在 5.2 节 介 绍 


种 可 


这 是 


介绍 


中 ， 


] 于 解决 许多 问题 的 通用 技术 ， 并 
成 功 处 理 了 一 些 难度 很 大 的 规划 实例 。 
了 几 种 其 他 的 规划 蔡 代 方法 ， 


了 基于 抽样 的 规划 算法 ， 


ne! 
Lo 


E 


TJ 
些 


在 5.3 
用 于 


cx 仑 保证 ， 


得 要 好 。5. 4 节 考 虑 了 微分 约束 


BT 


后 在 5.6 节 讨 论 了 运动 规划 相关 的 一 


主题 。 


1.1 构 型 空 


2.4 


CRIS 


机 器 人 的 一 个 根本 任务 ， 
位 置 的 无 碰撞 运动 ， 


到 目标 


静态 位 置 ， 


制 ， 
确定 性 、 


并 对 复杂 组 合体 进行 规划 来 实现 。 虽 然 问 
题 相 对 简单 ， 但 其 几 人 
另外 在 实际 机 器 人 中 ， 由 于 机 械 和 传 感 方面 
需要 通过 公式 的 扩展 对 这 些 问题 加 以 考虑 
反馈 和 微分 约束 ， 后 者 还 涉及 更 为 复杂 的 自 


具体 的 简单 规划 情况 ， 这 些 方 法 为 简单 规划 问题 


在 这 点 上 比 基 于 抽样 的 规划 做 
问题 。5. 5 节 概 述 
\ 式 描述 和 求解 方法 的 扩展 。 最 
些 重要 前 沿 


运动 规划 的 概念 VT eias Pista Eie bus S PEINE Eod deed ine 89 
s [8] 
.1.2 几何 路 径 规 划 问 题 
.1.3 运动 规划 的 复杂 度 
基于 抽样 的 规划 
综合 查询 规划 : 
2.2 单一 查询 规划 : 增 量 搜索 


映射 Gi 的 连接 性 …… 


就 是 要 实现 从 开始 位 置 
这 需要 通过 收集 障碍 物 的 


可 路 径 规 划 还 是 难以 计算 5 。 
的 一 些 限 
， 如 不 


动 规划 问题 。 现 代 算 法 已 经 在 几何 问题 上 比较 成 功 地 
解决 了 一 些 难 点 算 例 ， 并 一 直 在 努力 扩展 其 解决 更 具 


挑战 性 算 例 的 能 力 。 这 些 算法 的 应 用 范围 
人 学 领域 ， 如 用 于 计算 机 动画 、 


z 


已 超出 机 器 
虚拟 样机 和 计算 生物 


学 等 。 对 于 现代 运动 规划 技术 及 其 应 用 ， 现 有 的 许多 
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领域 。 


运动 规划 
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i$ 
5.3.1 组 合 路 线 图 PR 93 
5.3.0. 高 维 路 线 图 .PN 94 
5.3.83 热 场 和 95 
5.4 ”微分 约束 96 
5.4.1 概念 和 术语 PN 96 
5.4.2 约束 的 离散 化 PN 97 
5.4.3 Rf ee MMMHRHMMRRÜHRRHBR 97 
5.4.4 kinodynamic 规划 98 
DEEEN SCD LED 99 
5.5.1 闭 式 运动 链 ee M MMMHMHMMHMHMeHHeHHHR 99 
5.5.2. 操作 规划 m MMMMMHRR 99 
5.5.3 时 变 问 题 Ty TT PEE PAM EDI RET 99 
5.5.4 多 机 器 人 系统 eM 100 
5.5.5 预报 不 确定 性 ——— 100 
5.5.6 传 感 不 确定 性 MR 101 
5.6 高 级 问题 NEUESTE 101 
5.6.1 构 型 空间 的 拓扑 ce A 101 
5.6.2 样 理 论 eH 102 
5.6.3 代数 几何 计算 技术 PP essi ese rad 103 
5.7 ”结论 与 扩展 阅读 e 104 
Z3 MH 104 
5.1 运动 规划 的 概念 
本 市 只 提出 基本 运动 规划 间 题 (或 几何 路 径 规 
划 问 题 ) 的 描述 ， 至 于 将 这 些 基 本 公式 扩展 到 更 为 
复杂 的 情况 ， 将 在 后 面 章节 加 以 讨论 ， 并 将 贯穿 于 本 
书 之 中 5 
5.1.1 构 型 空间 
在 路 径 规划 中 ， 首 先 提出 机 器 人 A 和 工作 空间 
W 的 完整 几何 描述 : 工作 空间 W=R"， 其 中 N=2 


或 N=3， 为 含有 障碍 物 的 静态 外 部 环境 。 我 们 的 目 


已 经 涵盖 了 这 


的 是 为 机 器 人 A 找 出 一 条 无 碰撞 路 径 ， 
位 次 (位置 和 姿态 ) 移动 到 目标 位 次 。 


使 其 从 初始 
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为 实现 这 一 目标 ， 必 须 提 供 机 器 人 几何 位 置 上 的 
每 一 个 点 〈 即 构 型 9) 的 完整 说 明 。 这 里 引入 构 型 空 
间 ， 也 称 C 空间 (gs@) ， 它 是 所 有 可 能 构 型 所 组 成 
的 空间 。C 空间 表示 的 运动 学 变换 集 ， 能 用 于 第 1 章 
(运动 学 ) 中 表述 的 、 所 有 给 出 的 机 器 人 运动 学 变 
换 。 在 运动 规划 研究 中 ， 人 们 早 就 认识 到 C 空间 是 
一 个 很 有 用 的 途径 ， 它 能 将 各 种 规划 问题 抽象 为 统 
的 方式 。 这 种 抽象 的 优点 在 于 ， 具 有 复杂 几何 形状 的 
HLA, PARITE C 空间 的 一 个 点 上 ， 机 器 人 系 
统 的 自由 度数 是 C 空间 的 维 数 ， 或 者 是 指定 构 型 所 
需 参 数 的 最 小 个 数 。 

设 闭 集 OC Wea (工作 空间 的 ) 障碍 区 域 ， 通 
常用 多 面体 、 三 维 (3-D) 三 角形 或 分 段 代 数 曲 面 的 
形式 表示 。 设 闭 集 A(q) CW, Ron Lae A TE RAE 
qe CG 上 所 占据 点 的 集合 ， 它 通常 采用 与 9 相同 的 图 
元 来 模拟 。C 空间 障碍 区 域 Cu 定义 为 

Cu = lqe CIA(gq) NOA0) (5.1) 
HOA Ag) 均 为 WwW 上 的 闭 集 ， 因 此 障碍 区 
域 也 是 C 上 的 一 个 闭 集 。 无 (避免 ) 碰撞 的 构 型 集合 
Cree = C\GCu ， 称 为 自由 空间 。 

C 空间 简单 举例 如 下 。 

1) 平面 刚体 的 平移 。 机 器 人 构 型 可 用 一 个 参考 
点 (x, y) 来 表示 ， 这 个 点 位 于 相对 于 某 固 定 坐标 
的 平面 刚体 上 ， 因 此 这 里 C 空间 等 效 于 R”。 图 5.1 
给 出 了 一 个 三 角形 机 器 人 和 一 个 多 边 形 障 碍 物 所 构成 
的 C 空间 的 例子 。 其 中 C 空间 内 的 障碍 区 域 可 通过 
记录 机 器 人 在 工作 空间 障碍 物 周围 滑动 的 轨迹 ， 然 后 
REIA qe C 上 的 约束 来 实现 。 对 机 器 人 的 运动 规 
划 ， 就 等 效 为 对 C 空间 上 一 个 点 的 运动 规划 。 


(x.y) 
机 器 人 "4 ei 


障碍 物 


构 型 空间 障碍 
a) b) 
图 5.1 平面 上 的 机 器 人 平移 
a) 三 角形 机 器 人 在 带 有 单个 矩形 障碍 物 的 
工作 空间 上 移动 b) C 空间 障碍 


2) 平面 臂 。 图 5. 2 给 出 了 一 个 两 关节 平面 臂 的 例 
子 ， 两 个 连 杆 的 底部 钉 住 ， 因 而 只 能 沿 关节 做 无 限 位 
的 转动 。 对 于 这 个 臂 ， 用 参数 9, 和 0, 来 表示 构 型 ， 每 
个 关节 角 0; 对 应 于 单位 圆 S! 的 一 点 ， 因 而 C 空间 为 
Si xS = 了， 其 二 维 圆 面 环 如 图 5.2 所 示 。 对 于 无 关 


节 限 制 连 杆 数 更 多 的 情况 ，C 空间 可 类 似 的 定义 为 : 


a) b) 
图 5.2 二 维 圆 面 环 
a) 两 关节 平面 臂 (其 中 连 杆 钉 住 
且 无 关节 限制 ) b) C 空间 


QzS!xS! x xS! (5.2) 
如 果 关 节 有 限 位 ， 通常 可 用 有 限 区 间 R 来 蔡 代 相 
应 的 S!; 如 果 平 面 臂 的 底部 没有 钉 住 ， 是 可 移动 的 ， 
则 需要 考虑 在 辟 构 型 上 加 上 平移 参数 : 
Q-R?xS!xS!x--xS! (5.3) 
在 后 面 的 5. 6.1 节 ， 我 们 将 讨论 构 型 空间 的 拓扑 
属性 ， 并 提供 了 另外 一 些 C 空间 的 例子 。 


5.1.2 几何 路 径 规 划 问 题 


基本 运动 规划 问题 ， 又 称 为 钢琴 移动 问题 5 ， 
其 定义 如 下 。 

已 知 : 

1) 工作 空间 W， 这 里 W=R? 或 者 W=R;。 

2) 障碍 区 域 OC W。 

3) 定义 于 多 的 机 器 人 ， 它 为 一 个 刚体 4， 或 者 
m 个 构件 GEI) 的 集合 : A, A, rime 

4) 构 型 空间 @ (FE Cons PI Cree ) o 

5) 初始 构 型 gs Chee o 

6) 目标 构 型 Ye s Cis。 初始 构 型 和 目标 构 型 常 
称 作 查询 (qi, I) 。 

问题 : 计算 一 条 (连续 ) BRET: [0，1] 一 Cuee， 
使 得 r(0) =q, ETC) 2 qc. 


运动 规划 的 复杂 度 


运动 规划 中 最 主要 的 复杂 因素 在 于 ， 直 接 计算 
Cos Cre SOIE, 并且 C 空间 的 维 数 往往 很 高 。 Reif 
早先 研究 了 钢琴 移动 问题 ， 根 据 计 算 的 复杂 度 分 类 ， 
这 一 问题 被 证 明 为 PSPACE- hard'”" 1。 对 于 固定 维 数 
问题 ， 一 些 多 项 式 -时 间 算 法 指出 ， 问 题 的 难度 与 维 
度 具 有 指数 相关 性 后" Canny 提出 了 在 C 空间 
维度 上 的 单一 指数 -时 间 算 法 ， 这 一 问题 被 证 明 为 
PSPACE- complete?! 。 虽 然 该 算法 并 不 实用 ， 但 在 
基本 运动 规划 问题 研究 中 ， 可 作为 一 般 问题 的 难度 


5.1.3 
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上 限 。 它 应 用 计算 代数 几何 建 模 技术 ,对 C 空间 进 “5.6.2 和 节 。 


行 建 模 ， 来 构建 路 线 图 ， 即 一 个 具有 Ci 连接 性 的 
一 维 (1-D) 子 空间 。 关 于 这 一 技术 的 更 多 详情 ， 
见 5.6.3 节 。 

问题 的 复杂 度 ， 推 动 了 路 径 规 划 问 题 的 研究 。 其 
中 一 个 方向 是 采用 多 项 式 - 时 间 算 法 ， 研 究 普遍 问题 
的 某 些 子 类 “1,。 但 即使 是 这 样 一 些 简单 的 运动 规划 
特例 ， 仍 然 被 看 做 是 一 种 挑战 ， 例 如 R?” 中 ， 平行 于 
轴 的 和 矩形 做 有 限 次 平移 ， 这 种 简单 情况 ， 其 复杂 度 也 
是 PSPACE-hard。 对 某 些 运动 规划 的 扩展 就 更 难 了 
例如 ，3 维 多 面 体 环境 中 ， 不 确定 性 下 的 某 种 规划 玫 
式 为 NEXPTIME- hard? P? ,, NEXPTIME 中 最 大 的 难题 
在 于 需要 双 倍 指数 的 时 间 来 进行 求解 。 

另外 一 个 方向 是 替代 运动 模式 的 发 展 ， 替 代 模 式 
的 假设 建立 在 实际 应 用 的 基础 上 。 组 合 方法 能 通过 特 
定 的 二 维和 三 维 问题 ， 来 有 效 构 建 一 维 线路 图 ; 势 场 
法 通过 定义 矢量 场 ， 能 够 跟随 机 器 人 朝 目 标的 运动 。 
然而 ， 这 两 种 方法 都 不 能 成 规模 地 用 于 普遍 情况 ， 这 
些 将 在 5.3 节 讲 述 。 基 于 抽样 的 规划 是 另外 一 种 蔡 代 
模式 ， 它 作为 一 种 常用 方法 ， 已 被 证 明 能 成 功用 于 解 
决 实践 中 的 许多 难题 。 此 方法 虽然 避免 了 C 空间 的 
精确 几何 模拟 问题 ， 但 却 不 能 保证 算法 的 完备 性 。 因 
为 完备 、 精 确 的 算法 能 够 检测 出 无 路 径 寻 的 情况 ， 而 
基于 抽样 的 规划 方法 ， 只 能 提供 较 低 水 平 的 完备 性 保 
证 。 这 种 模式 将 在 下 面 一 节 讲述 。 


5.2 基于 抽样 的 规划 


NN 


T 


本 节 首 先 讲 述 基于 抽样 的 规划 ， 因 为 对 于 很 多 通 
常 类 型 的 问题 ， 都 可 以 选用 这 种 方法 ， 下 一 节 将 讲述 
其 他 方法 ， 它 们 中 的 一 些 还 早 于 抽样 规划 架构 。 基 于 
样 规划 的 核心 思想 ， 是 利用 碰撞 检测 算法 的 进步 ， 
来 计算 单个 构 型 是 否 为 无 碰撞 。 给 出 简单 图 元 后 ， 规 
划 器 通过 对 不 同 构 型 进行 采样 并 构建 数据 库 ， 用 于 存 
储 一 维 C 空间 曲线 ， 它 代表 无 碰撞 路 径 。 在 这 种 方 
法 中 ， 基 于 抽样 的 规划 器 不 直接 接近 C 空间 的 障碍 ， 
而 是 通过 碰撞 探测 器 和 构建 数据 结构 来 进行 。 使 用 这 
种 抽象 层次 ， 对 于 特定 的 机 器 人 及 其 应 用 ， 通 过 合理 
布置 取舍 碰撞 探测 器 ， 规 划 器 能 广泛 适用 于 多 种 问题 。 

对 于 基于 抽样 的 规划 器 而 言 ， 其 标准 是 提供 一 个 


如 何 进行 抽样 构 型 和 构建 何 种 数据 结构 ， 不 同 的 
规划 有 不 同 的 方法 。5. 6. 2 节 将 对 抽样 问题 进行 更 深 
入 的 探讨 。 对 于 基于 抽样 的 规划 器 ， 典 型 的 分 为 两 
类 : 多 查询 方法 和 单 查询 方法 。 

在 第 一 类 中 ， 首 先 构建 路 线 图 ， 规 划 器 预先 计算 
一 次 无 向 图 C， 以 便 映 射出 Ci 空间 的 连接 属性 。 完 
成 这 一 步 后 ， 相 同 环境 下 的 多 查询 回答 只 需要 运用 已 
构建 的 路 线 图 即 可 。 这 类 规划 器 在 5.2.1 节 讲 述 。 
第 二 类 规划 方法 ， 通 过 联机 给 出 规划 查询 的 树 数 
据 结构 ， 规 划 器 集中 搜索 C 空间 的 一 部 分 ， 以 尽 可 
能 快 地 解答 具体 的 查询 问题 。 这 类 规划 将 在 5.2.2 节 
讲述 。 

两 类 方法 对 于 碰撞 图 元 检查 的 用 法 是 相似 的 ， 碰 
撞 探 测 器 的 目的 就 是 要 报告 给 定 目标 几何 构 型 和 变换 
间 的 所 有 几何 接触 。 规 划 器 软件 包 的 实用 性 在 
于 ， 能 在 几 分 之 一 秒 内 完成 碰撞 查询 ， 这 对 于 基于 规 
划 抽 样 算法 的 发 展 至 关 重 要 。 现 代 规 划 采 用 黑箱 
(black box) 作为 碰撞 探测 器 ， 最 初 规划 器 提供 所 有 
涉及 目标 的 几何 条 件 ， 并 指出 其 中 哪些 是 可 移动 的 ; 
然后 为 验证 机 器 人 的 构 型 ， 向 相关 的 机 器 人 提供 运动 
变换 ， 碰 撞 探 测 器 回应 目标 间 是 否 有 碰撞 。 许 多 软件 
包 对 几何 模型 采用 分 级 表示 ， 以 避免 计算 中 全 是 两 个 
两 个 地 相互 作用 ， 并 采用 二 分 搜索 法 来 评估 碰撞 。 除 
了 构 型 外 ， 规 划 器 还 必须 验证 全 部 路 径 。 一 些 碰撞 探 
测 器 返回 碰撞 距离 信息 ， 这 可 以 有 效用 于 推断 C 空 
间 中 的 全 部 邻 域 。 这 种 提取 信息 的 方法 代价 很 高 ， 但 
如 果 采 用 小 步 长 增 量 或 二 分 搜索 方式 逐 点 验证 路 径 ， 
往往 代价 更 高 。 一 些 碰 撞 探 测 器 设计 为 步 进 式 的 ， 以 
便 它们 能 重新 使 用 以 前 的 查询 信息 ， 因 而 速度 
BRO 。 


综合 查询 规划 : 映射 Cre 的 连接 性 


规划 器 则 在 解答 某 一 静态 环境 中 的 多 重 查 询 时 ， 
在 预 处 理 阶 段 采 用 将 Ci 的 连接 性 映射 到 路 线 图 中 。 
该 路 线 具有 图 G 的 形式 ， 并 带 有 构 型 项 点 和 路 径 边 
线 。 如 果 满 足下 列 性 质 ， 则 1 维 曲 线 的 并 集 为 路 线 
图 C。 

1) 可 达 性 。 由 任意 que Ch， 可 简单 有 效 地 计 


5.2.1 


完备 性 较 弱 ， 但 仍 值得 关注 的 规划 形式 : 如 果 解 的 路 


算 一 条 路 径 T. [0, 1] Cre, 以 使 71(0) =q, H 
t(1) 2s, Hips 为 S(G) 中 的 任意 一 点 ，S(CC) ÆG 


径 存 在 ， 那 么 规划 口 就 会 最 终 找 到 它 。 放 弃 更 强 的 完 
备 性 形式 ， 这 也 要 求 在 有 限时 间 内 能 报告 失效 情况 ， 
这 项 技术 能 解决 三 自由 度 以 上 完备 性 方法 所 不 能 解决 
的 实际 问题 。 完 备 性 弱 形式 的 更 详细 介绍 ， 安 排 在 


的 行 迹 ， 为 边线 和 顶点 能 到 达 的 所 有 构 型 合集 。 这 意 
味 着 总 是 可 以 将 规划 查询 对 gq, 和 gq. 分 别 与 5(G) 上 
的 某 对 SA 5S。 连接 起 来 。 

2) 连接 性 保护 。 第 2 个 条 件 要求 : 如 果 存 在 路 


92 第 1 篇 


机 器 人 学 基础 


径 T: [0, 1] 一 Ce 使 得 7(0) =q, HT) =gc， 则 
EFEKT: [0, 1] 一 S$S(G), fiit$v (0) =q, 
T(1) =ge， 这 样 就 可 以 避免 由 于 G 未 能 捕捉 到 Cre 
的 连接 性 ， 而 出 现 解 丢失 的 情况 。 

概率 路 线 图 方法 ( PRM) 在 计算 概率 方面 ， 
采用 的 是 近似 路 线 图 的 方式 。RPM 的 预 处 理 阶段 ， 
通常 可 扩展 为 基于 抽样 的 路 线 图 ， 步 又 如 下 : 

1) 初始 化 。 设 C(P E) 表示 一 个 无 向 图 ， 初 
始 状态 为 空 。G 的 顶点 将 对 应 于 无 碰撞 构 型 ， 连 接 顶 
点 的 边线 对 应 于 无 碰撞 路 径 。 

2) 构 型 采样 。 将 从 Ci 中 抽样 得 到 的 构 型 q(i)， 
MAMAR VP, Kal) 表示 无 限 、 密 集 的 样本 
序列 ，a(i) 为 这 个 序列 中 的 第 i 个 点 。 

3) 邻 域 计算 。 通 常 在 C 空间 中 定义 一 个 度量 ， 
p: €x CR 。 存 在 于 了 中 的 顶点 494， 如 果 依 照度 量 p 
为 小 距离 ， 则 可 选 为 a(i) 邻 域 的 一 部 分 。 

4) 边线 考虑 。 对 于 不 属于 G 上 相同 连接 分 量 
a(i) 的 那些 顶点 9， 该 算法 通过 边线 将 其 相连 。 

5) 局 部 规划 方法 。 给 定 ai) 和 ge Cie, XH 
模块 来 构建 路 径 T,: [0,1]—Q, 使 得 T(0) = 
ali), t(1) 2 qo 采用 碰撞 检测 ，7, 必 须 通 过 检查 以 
确保 不 产生 碰撞 。 

6) 边线 插入 。 YE c RA E, 作为 由 a(i) 到 4 
的 边线 。 

7) Aik, 通常 当 预定 义 的 无 碰撞 顶点 数 N 已 加 
入 到 路 线 图 中 时 ， 算 法 停止 。 

算法 在 本 质 是 增 量 形式 的 ， 计 算 可 从 一 个 已 存在 
的 图 上 重复 开始 。 通 用 的 基于 抽样 的 路 线 图 ， 总 结 在 
算法 5.1 中 。 


算法 5.1 
基于 抽样 的 路 线 图 
N: 路 线 图 中 包含 的 节点 数 
G. init() ; i—0; 
while ; « N do 
if a(i) € Cre then 
G. add. vertex(a(i) ) ; i—i 41 
for q e NEIGHBORHOOD(a(i), G) do 
if CONNECT(a(i), q)then 
G. add edge( a( i) ,q) ; 
endif 
end for 
endif 
end while 


图 5.3 为 算法 行为 的 图 形 描述 。 为 求解 一 个 
查询 ,将 g, 和 gq 连接 到 路 线 图 ， 并 执行 图 搜索 
任务 。 


递增 构建 基于 抽样 的 路 线 图 


对 于 原始 PRM"! ， 构 型 (i) 采用 随机 抽样 产 
生 。 对 于 g Mali) 之 间 的 连接 步 ， 算 法 中 采用 C 空 
间 上 的 直线 路 径 。 在 某 些 情况 下 ， 如 果 g 和 a(i) 在 
相同 连接 分 量 上 ， 则 不 用 连接 。 许 多 后 续 工作 可 用 于 
在 更 少 采 样 点 的 情况 下 提高 路 线 图 的 质量 : 在 Ci 的 
边界 点 (或 靠近 ) 进行 集中 采样 的 方法 见 参考 文献 
[5.20, 21]; 远离 边界 点 处 的 移动 采样 方法 见 参考 
文献 [5.22, 23]; 包含 网 络 的 确定 性 抽样 技术 见 参 
考 文献 【5.24] ; 基于 交互 可 视 性 的 顶点 剪 枝 方法 ， 
可 大 为 减少 路 线 图 的 项 点数 ;基于 抽样 路 线 图 的 
理论 分 析 见 参考 文献 [5.24, 26, 27], ， 并 在 5.6.2 
节 作 了 简要 论述 ; 文献 [5.28] 对 基于 抽样 的 路 线 
图 不 同形 式 进行 了 实验 对 比 ; 对 于 路 线 图 方法 中 识别 
狭窄 通道 的 难点 问题 ， 有 人 建议 采用 网 桥 测试 来 进行 
NHAC? ;， 对 于 基于 概率 路 径 图 (PRM) 的 其 他 
法 见 参考 文献 【5.30-34]。 本 主题 的 更 多 讨论 可 参 
阅 参 考 文献 [5.5, 7]. 


5.2.2 单一 查询 规划 : 增 量 搜索 


单一 查询 规划 方法 集中 于 一 个 单一 初始 目标 构 型 
对 ， 通 过 延伸 树 型 数据 结构 ， 探 查 连 续 的 C 空间 。 
数据 结构 在 这 些 已 知 构 型 中 初始 化 ， 并 最 终 与 它们 相 
连 。 大 多 数 单一 查询 方法 遵循 以 下 步骤; 

1) 初始 化 : WEG(V, E) 表示 一 个 无 向 搜索 图 ， 
顶点 集 V 包含 Cae 中 的 一 个 (HA) 或 多 个 构 型 的 


连接 顶点 的 各 边线 为 无 磁 撞 路 径 。 
2) 顶点 选择 方法 : 选择 一 个 用 于 扩展 的 顶点 
Gow € Vo 


第 5 章 


动 规 划 93 


3) 局 部 规划 方法 : 对 某 些 gs E Cree, XIE F 
一 个 存在 于 V 中 的 项 点, 但 在 不 同 的 树 或 样本 构 型 
上 。 构 建 一 条 路 径 Tt.: [0, 1] 一 Cre， 使 得 T(0) = 
qu. T1) Saono 采用 碰撞 检测 ， 则 + 必须 检查 以 确 
保 不 会 引起 碰撞 。 如 果 这 一 步 未 能 产生 一 个 无 磁 撞 路 
径 段 ， 则 转向 第 2 步 。 

4) 在 图 中 插入 边线 : YE c LACE 中 ， 作 为 一 条 
从 gi 到 gq, 的 边线 。 如 果 gq, 还 不 在 V 中 ， 则 它 也 需 
要 搬入。 

5) 求解 检查 : 确定 6 的 编码 是 否 为 求解 路 径 。 

6) 返回 第 2 步 : 除非 满足 终止 条 件 ， 算 法 将 返 
回 第 2 步 继 续 授 代 。 这 里 终止 条 件 一 是 解 已 经 找到 ， 
二 是 满足 设 定 的 终止 条 件 ， 这 种 情况 下 报告 算法 失败 。 

在 执行 过 程 中 ，C 可 以 组 织 一 个 或 多 个 树 ， 这 会 
导致 : 

1) 单 向 方法 。 它 只 包含 单 棵 树 ， 通 常 根 在 
qg Fh) 

2) 双向 方法 。 它 包含 两 棵 树 ， 通 常 根 在 qu 
qb, 

3) 多 向 方法 。 它 可 有 两 棵 以 上 的 树 5 “7 。 采 
用 多 棵 树 的 动机 在 于 ， 在 通过 狭窄 通路 寻找 出 口 时 ， 
单一 树 可 能 存在 陷阱 ， 而 在 相反 方向 返回 时 ， 可 能 会 
更 容易 些 。 

随 着 所 考虑 树 数 的 增多 ， 确 定 树 之 间 如 何 进行 连 
接 ， 将 变 得 更 为 复杂 。 

1. 快速 搜索 密集 树 

此 类 技术 的 主要 想法 是 , 算法 应 逐渐 加 强 对 C 
空间 属性 的 探测 力度 。 实 现 这 一 目标 的 算法 ， 称 为 快 
速 搜索 随机 树 (RRT) ^77, ATs JH T Desk R 
密集 树 (RDT) ， 进 行 任意 密度 、 确 定性 或 随机 抽 
样 1。 其 基本 思想 是 ， 通 过 树 上 选择 的 一 个 扩展 
点 ， 在 搜索 过 程 中 引入 Voronoi 偏 置 。 采 用 随机 样本 ， 
顶点 选择 的 概率 与 Voronoi 区 域 的 体积 成 正比 。 其 树 
结构 概述 如 下 : 


算法 5.2 

快速 搜索 密集 树 

k: 算法 的 搜索 步 

G. init(q,) ; 

for i=1 to k do 
G. add. vertex(a(i) ) ; 
q,*—NEAREST(S(G) , a(i)); 
G. add edge(q,, a(i)); 


end for 


树 从 gi 开始 ， 在 每 次 迭代 中 ， 加 入 一 个 边线 和 


到 目前 为 止 , 还 没有 说 明 如 何 到 达 ge 的 问题 。 
采用 RDT 的 规划 算法 有 好 几 种 : 一 种 方法 是 偏 置 
a(i), LAE ge 能 频繁 选择 (或 许 每 50 次 迭代 就 要 选 
择 一 次 ) ; 另外 更 有 效 的 方法 是 通过 培育 两 棵 树 ， 开 
发 双向 搜索 算法 ,通过 彼此 的 g% 和 gc 进行 搜索 ， 这 
大 约 有 一 半 时 间 花 费 在 用 常规 方式 扩展 每 棵 树 ， 而 另 
一 半 时 间 则 花费 在 对 树 的 连接 上 。 连 接 树 的 最 简单 方 
式 是 ， 让 一 棵 树 的 最 新 顶点 在 扩展 另 一 棵 树 时 替代 
a(i)。 其 技巧 是 采用 基本 扩展 算法 ， 将 一 个 RDT 连 
接 到 男 外 一 个 上 5 *]。RDT 方法 经 过 不 断 扩 展 ， 现 
已 应 用 到 多 个 方面 5? 2 ， 更 详细 的 描述 见 参考 
文献 [5.5, 7]。 

2. 其 他 算法 

参考 文献 [5.43-45] 中 提出 了 基于 扩展 空间 
的 规划 方法 。 在 这 种 情况 下 ， 由 于 在 顶点 周围 邻 域 
内 的 点 很 少 ， 算 法 通过 选择 扩展 顶点 进行 强制 搜索 。 
在 参考 文献 [5.46] 中 ， 通 过 自 调 节 随 机 行走 以 获 
取 额 外 性 能 ， 其 实质 是 将 所 有 努力 集中 用 于 搜索 。 
其 他 成 功 的 树 算法 ,包括 路 径 定向 细 分 树 算法 
及 其 一 些 变 体 “。 在 这 些 文献 中 ， 有 时 很 难 将 基 
于 树 的 规划 器 用 于 普通 路 径 规 划 中 ， 因 为 它们 中 的 
许多 (包括 RDT) 需要 设计 为 (或 应 用 于 ) 更 复杂 
的 问题 ( 见 5.4.4 节 )， 其 性 能 对 于 多 种 路 径 规划 
问题 也 很 出 色 。 


5.3 ”替代 算法 


对 于 基于 抽样 的 算法 ， 替 代 方 法 包括 基于 势 场 技 
术 方 法 和 组 合 方法 ， 它 也 可 以 生成 路 线 图 ， 例 如 单元 
分 解 。 这 些 算 法 能 有 效 解决 狭窄 类 型 问题 ， 在 这 些 情 
况 下 ， 更 优 于 5. 2 节 的 算法 。 多 数组 合算 法 主要 用 在 
理论 人 研究 方面 ， 而 基于 抽样 算法 的 主要 动机 在 于 解决 
应 用 中 的 性 能 问题 。 当 然 ， 经 过 某 些 抽象 ， 组 合算 法 
也 能 用 于 解决 实际 问题 ， 如 移动 平面 机 器 人 的 自主 时 
航 问题 。 


5.3.1 组 合 路 线 图 


有 几 种 算法 适用 于 C= 民 ”， 且 Cw 为 多 边 形 的 情 
况 。 这 些 算 法 大 多 虽 不 能 直接 扩展 到 高 维 情况 ， 但 某 
些 基 本 原理 是 相同 的 。 最 大 间 际 路 线 图 (或 称 收缩 
Jrik 7) 构建 路 线 图 时 ， 它 使 路 径 尽 可 能 远离 障 
碍 物 ， 其 路 径 通 过 图 5.4 所 示 的 三 种 情况 形成 路 线 
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图 ， 它 对 应 于 所 有 与 多 边 形 属性 配对 的 路 线 。 通 过 
生成 所 有 曲线 对 的 可 能 配对 ， 计 算 交 集 并 画 出 路 线 
图 ， 这 样 就 可 以 在 时 间 O(n") 上 构造 出 路 线 图 ( 见 
图 $.5) 。 有 些 现存 的 算法 能 提供 更 好 的 渐 近 运行 时 
[8^5* ， 但 它们 实现 起 来 相当 困难 。 其 中 最 著名 的 
算法 运行 在 0(n lon) WEE, XE n 为 路 线 图 曲 
ZR, 


9E 3 f 
边线 一 边线 顶点 一 顶点 顶点 一 边线 


图 5.4 Voronoi 路线 图 线段 产生 的 三 种 可 能 情况 
(第 三 种 情况 为 二 次 曲线 ) 


Qn 


图 5.5 如 果 有 障碍 物 ， 碰撞 检测 算法 允许 
边线 一 直行 进 到 障碍 物 的 边界 


如 图 5. 6 所 示 ， 另 一 种 替代 方法 是 计算 最 短路 径 
路 线 图 ?1 。 这 与 上 一 节 提 出 的 路 线 图 不 同 ， 因 为 考 
虑 路 径 最 佳 ( 短 )， 故 允许 路 径 可 触及 至 障碍 物 。 顶 
点 的 内 角 大 于 m 时 ， 路 线 图 的 顶点 是 C% 的 反射 顶 
点 ， 当 且 仅 当 一 对 顶点 相互 可 见 时 ， 路 径 图 的 边线 存 
在 ， 从 每 个 顶点 中 伸 出 一 条 线 (这 条 线 称 为 双 切 
£X), ， 该 线 通 过 顶点 对 伸 向 Co。。 对 每 个 反射 角 采 用 
径 向 扫描 算法 ， 可 形成 OC’ lgn)- 时 间 结 构 算 法 。 理 
论 上 可 以 在 时 间 OC? +m) 上 计算 ,其 中 m 是 路 线 
图 上 边线 的 总 数 呈 3 。 

图 5.7 显示 的 是 垂直 单元 分 解 方法 。 其 思想 是 将 
Cie 分 解 为 梯形 或 者 三 角形 单元 ， 每 个 单元 上 的 规划 是 
平凡 的 ， 因 为 其 为 凸 面 。 路 线 图 由 这 样 一 系列 点 构成 ， 
这 些 点 放置 于 每 个 单元 及 单元 间 每 条 边界 的 中 心 处 。 任 
何 一 种 图 搜索 算法 均 可 用 于 快速 找到 无 碰撞 路 径 。 采 用 
SPO Oe ， 单 元 分 解 可 在 O(n len) 时 间 上 
构建 。 设 想 一 条 垂 线 从 x = — w Sx = + o 进行 扫描 ， 
当 遇 到 多 面体 的 顶点 时 停 下 来 ， 在 这 种 情况 下 ， 一 个 
单元 的 边界 可 能 必定 位 于 顶点 的 上 面 / 或 下 面 ， 需 要 
在 平衡 搜索 树 上 保持 垂 线段 的 次 序 ， 这 样 才能 在 时 间 


图 5.6 最 短路 径路 线 图 ， 包括 Covs 上 连续 
反射 顶点 间 的 边 及 其 双 切 线 边 


O(lgn) 内 对 垂直 单元 的 边界 进行 限定 。 整 个 算法 在 
时 间 O(n Ign) 上 运行 ， 因 为 有 O(n) 个 顶点 ， 在 这 
些 点 处 能 让 扫描 线 停 下 来 。 也 就 是 说 ， 顶 点 需要 一 开 
台 就 进行 排序 ， 这 需要 时 间 O(n lgn)。 


图 5.7 垂直 单元 分 解 得 到 的 路 线 图 


5.3.2 高 维 路 线 图 


如 果 将 5.3.1 节 的 方法 直接 扩展 到 更 高 维 数 ， 
可 能 会 更 为 方便 。 尽 管 很 遗憾 不 会 发 生 这 种 情况 ， 
但 还 是 能 够 从 中 扩展 一 些 总 体 思路 。 考 虑 高 维 情况 
的 单元 分 解 ， 主 要 有 两 条 要 求 : 中 每 个 单元 应 该 足 
够 简单 ， 以 便 单 元 上 的 运动 规划 是 平凡 的 ; 四 单元 
应 能 很 好 地 组 合 在 一 起 。 对 第 一 条 要 求 ， 充 分 条 件 
是 单元 为 凸 面 ， 也 可 以 允许 为 更 一 般 的 形状 ， 但 在 
任何 情形 下 ， 单 元 都 不 能 含有 孔 。 对 第 二 条 要 求 ， 
充分 条 件 是 单元 能 被 组 合成 一 个 奇异 复 形 ， 这 意味 
着 对 任意 两 个 d 维 单元 (den), ， 如 果 两 单元 的 边 
界 相交 (UD), ， 那 么 共同 边界 本 身 必 须 是 一 个 〈 低 
维 的 ) 完备 单元 。 

在 二 维 多 边 形 C 空间 上 ， 三角 法 定义 的 好 单元 
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分 解 可 适用 于 运动 规划 。 如 要 找到 一 个 好 三 角形 ， 就 
要 尽量 避免 薄 三 角形 ， 这 在 计算 几何 中 应 加 以 考 
ESS 。 确 定 带 孔 多 面体 障碍 区 域 的 分 解 时 ， 需 要 用 
到 最 小 凸 单 元 数 ， 它 为 NP- hard ^^" 。 鉴 于 此 ， 我 们 
仍 乐意 采用 非 最 佳 分 解 方式 。 

在 三 维 C 空间 中 ， 如 果 Cu 是 多 面体 ， 则 可 采用 
平面 递归 扫描 ， 直 接 对 垂直 分 解 方法 进行 扩展 。 例 
如 ， 临 界 同 相 轴 可 能 出 现在 每 个 z 坐标 上 ， 对 其 上 的 
点 进行 二 维 垂直 分 解 变化 时 ，* 和 y 坐标 保持 不 变 。 
通过 机 器 人 在 RR 中 多 面体 障碍 物 间 的 平移 ， 可 以 得 
到 多 面体 的 例子 ; 然而 最 有 趣 的 问题 是 Qu. 变 为 非 线 
性 情况 。 假 设 C = R? x S', 对 应 于 机 器 人 能 够 在 平 
面 上 平 动 和 转动 。 假 设 机 器 人 和 障碍 物 都 是 多 边 形 ， 
对 于 线段 机 器 人 的 情形 ， 参 考 文献 [5.57] 给 出 的 
O(n?) 算法 能 够 实现 ; 对 于 更 为 一 般 的 模型 及 C 空 
间 情 况 ， 此 方法 已 很 难 用 于 实际 问题 ， 而 主要 用 于 理 
论 研 究 ， 这 将 在 5.6.3 节 进 行 介 绍 。 


势 场 


运动 规划 的 不 同方 法 ， 其 灵感 均 来 自 于 不 同 的 避 
BPE ARO OS 。 虽 然 没 有 明确 构建 一 个 路 线 图 ， 而 是 构 
建 一 个 可 微 的 实 值 函数 U: R"R ， 称 为 势 函 数 ， 
由 它 导 出 移动 目标 的 运动 。 如 图 $. 8 所 示 ， 势 的 典型 
构造 是 : 它 包含 一 个 吸引 分 量 U, (a) ， 拉 着 机 器 人 朝 
目标 运动 ;另外 还 包括 一 个 排斥 分 量 U, Cq), HEH 
器 人 远离 障碍 。 势 函数 的 梯度 为 一 个 矢量 V U(g) = 


DU(q)' = ge i, aw] ， 其 指向 为 U 的 


局 部 最 大 增加 方向 。 定 义 U Za, Meg, 开始 采用 梯 
度 下 降 法 ， 就 能 计算 出 路 径 : 

1) q(0) 24, i=0 

2) while VU(q(i)) 40 do 

3) q(i 1) =q(i) +V U(g(i)) 

4) i=i+1 

然而 ， 这 种 梯度 下 降 方 法 并 不 保证 能 得 到 问题 
的 解 ， 因 为 梯度 下 降 只 能 到 达 U(g) 的 一 个 局 部 最 
小 值 ， 如 图 5.9 所 示 ， 它 可 能 与 目标 状态 ge 并 不 
相符 。 

既 利 用 势 函 数 ， 又 避免 局 部 最 小 问题 的 规划 方 
法 ， 称 之 为 随机 势 规 划 ””。 其 思想 是 采用 多 重 规划 
模式 ， 通 过 随机 行走 (random walk) 来 组 合 势 函数 。 
在 第 1 重 模式 中 ， 梯 度 下 降 法 用 至 达到 一 个 局 部 最 小 
值 时 为 止 ; 第 2 重 模式 是 用 随机 行走 来 设法 避 开 局 部 
最 小 值 ; 第 3 重 模式 是 当 多 次 避 开 局 部 最 小 值 的 努力 
都 已 失败 时 ， 执 行 回溯 法 。 这 种 方法 在 许多 情况 下 被 


5.3.3 


图 5.8 引力 和 斥 力 分 量 定义 势 函 数 


看 作 是 基于 抽样 的 规划 ， 它 也 提供 了 弱 完 整 性 保证 ， 
但 需要 参数 调整 。 近 来 基于 抽样 的 方法 达到 了 更 好 的 
性 能 ， 它 主要 通过 花费 更 多 时 间 进 行 空 间 搜 索 ， 而 不 
是 将 重点 放 在 势 函 数 上 。 

势 函 数 的 梯度 也 能 用 于 定义 矢量 场 ， 它 可 在 任意 
构 型 ge C 上 对 机 咒 人 指定 一 个 运动 。 这 种 方法 的 主 
要 优点 不 仅 限 于 其 计算 效率 ， 因 为 它 不 只 是 一 个 单一 
的 路 径 计算 ， 也 是 一 个 反馈 控制 策略 ， 这 使 得 方法 更 
具 重 棒 逆 向 控制 和 传 感 误 差 。 反 馈 运 动 规划 技术 大 多 
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图 5.9 势 函数 求解 局 部 最 小 问题 的 两 个 例子 


是 基于 导航 函数 的 思想 9%1 ， 即 合理 构造 势 函数 ， 使 
ZARA Mie ME, PAB D: Co 一 [0,1] 称 为 导航 
函数 ， 如 果 它 : 
1) 是 平滑 的 (或 至 少 在 k=2 的 CC 上 平滑 ) 。 
2) 在 4 处 具有 唯一 最 小 值 ，C 空间 的 连接 分 量 
BE dco 
3) 在 C 空间 的 边界 上 具有 均匀 最 大 值 。 


图 5. 10 球形 空间 和 星 形 空间 示例 


4) 且 为 Morse， 即 所 有 的 临界 点 (如 鞍点 ) 是 
孤立 的 ， 可 通过 小 随机 扰动 加 以 避免 。 
如 图 5.10 所 示 ， 对 于 只 包含 球形 障碍 物 的 情况 ， 
导航 函数 可 以 构建 成 球 心 为 gi 的 球 边界 空间 。 然 后 它 
们 还 可 扩展 到 微分 同 胚 于 球 空间 的 大 的 C 空间 族 ， 
例如 图 5.10 所 示 的 星 形 空间 。 反 馈 运 动 策 略 的 详细 
阐述 见 本 书 的 第 35 、 第 36 和 第 37 章 。 
除了 局 部 最 小 问题 之 外 ， 对 于 势 函 数 方法 ， 
另 一 个 主要 的 挑战 是 如 何 构建 并 表示 C 空间 ， 这 
一 难题 使 得 在 高 维 问题 中 ， 该 技术 的 应 用 显得 过 


于 复杂 。 


5.4 微分 约束 


机 器 人 运动 通常 必须 符合 全 局 和 局 部 两 种 约束 ， 
在 C 上 ,全 局 约束 以 障碍 物 和 关节 限 位 形式 加 以 考 
JE; 局 部 约束 则 通过 微分 方程 进行 模拟 ， 因 而 称 作 微 
分 约束 。 出 于 运动 学 考虑 ( 如 轮 的 接触 点 ) 和 动力 
学 考虑 〈 如 动量 矩 守恒 ) ， 约 束 方程 限定 了 每 个 点 的 
速度 及 可 能 的 加 速度 。 


概念 和 术语 


5.4.1 


设 4 为 速度 矢量 ,C 上 的 微分 方程 可 表示 成 隐 式 
形式 gj (a, 4) =0， 或 者 参数 形式 x -f(q, u), Và 
式 形式 更 为 一 般 ， 但 往往 更 难于 理解 和 利用 。 在 参数 
形式 中 ， 矢 量 值 方程 预示 速度 要 通过 给 定 的 g 和 zx 来 
求 ， 其 中 心 为 输入 ， 选 自 于 某 些 输入 空间 V。 设 了 表 
示 时 间 间 隔 ， 并 从 1=0 时 刻 开始 。 

为 模拟 动力 学 问题 ， 需 要 将 概念 扩充 到 C 空间 
的 相 空 间 著 上。 通常 每 个 点 xe 站 表示 构 型 和 速度 ， 
即 x=(4g4，q4)。 采 用 隐 式 形式 和 参数 形式 都 可 能 ， 
分 别 表示 为 g& (xz，xz) =0 Mx - f(x, u), 后 者 为 一 
种 常见 的 控制 系统 的 定义 。 注 意 x =(q, 7), 这 
预示 着 可 以 对 加 速度 约束 和 完整 系统 动力 学 进行 
表达 。 

在 状态 空间 于 中 进行 规划 ， 可 引出 对 关 ,. 的 直接 
定义 : 对 于 x = (gq,，4 )， 当 且 仅 当 ge Cs 时， 有 
XeX,.。 然 而 ,还 存在 男 外 一 种 可 能 性 ， 它 基于 必 
然 碰 撞 区 域 概念 ， 能 直观 地 反映 动力 学 的 规划 问题 ， 
其 定义 如 下 : 

X,, = {x(0) eX |forany u e Uz, 
Jt »0 such that x(t) E Xas}, 


(5.4) 
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RP, x(1) 为 1 时刻 的 状态 ， 可 通过 控制 函数 u 
TU， 从 x(0) 积分 得 到 ; Un 为 预先 确定 的 所 有 可 
能 控制 函数 的 集合 ; XQ 表示 这 样 一 个 状态 集 : EE 
上 面 机 器 人 会 发 生 碰撞 ; 或 者 由 于 动量 的 缘故 ， 不 能 
避免 发 生 碰撞 ， 如 图 5.11 所 示 。 它 可 被 视 为 一 种 无 
形 的 障碍 区 域 ， 并 随 速 度 增 大 而 增长 。 


NS 


图 5.11 必然 碰撞 区 随 速度 呈 平 方 关系 增长 


在 微分 约束 规划 的 总 标题 下 ， 有 许多 重要 的 问题 
类 别 ， 大 量 研究 文献 已 对 此 加 以 关注 。 在 轮 式 移动 机 
器 人 的 研究 中 ， 引 入 了 非 完整 性 规划 的 术语 5 ， 举 
个 简单 的 例子 : 由 于 汽车 不 能 侧面 移动 ， 从 而 使 平行 
泊 停 车 变 得 困难 。 一 般 情 况 下 ， 非 完整 约束 为 微分 等 
式 约束 ， 不 能 积分 成 不 含 导数 项 的 约束 形式 。 机 器 人 
学 中 出 现 的 典型 非 完 整 性 约束 ， 可 以 是 车 轮 接 触 等 运 
动 学 引起 的 1， 也 可 能 是 起 因 于 动力 学 。 

如 果 包 含 约束 的 规划 问题 中 ， 至 少 涉 及 速度 和 加 
速度 ， 该 问题 常 被 称 为 kinodynamic 规划 1。 通常 
模拟 成 全 驱动 系统 ， 表 示 为 q -h(q, q, u), HH 
U KNBR" 原点 的 一 个 开 集 (3X HU n Jé U I CHIE 
数 ) 。 约 束 问题 可 能 既是 非 完 整 的 ， 又 是 kinodynamic 
问题 ， 或 者 二 者 都 不 是 ; 然而 目前 该 项 还 没有 更 精确 
的 表示 。 

轨迹 规划 是 另外 一 个 重要 概念 ， 它 主要 用 于 确定 
机 融 手 的 路 径 和 速度 函数 问题 (如 PUMA560) 。 在 下 
面 的 处 理 中 ， 所 有 这 些 都 称 作 微 分 约束 规划 。 


5.4.2 约束 的 离散 化 


在 微分 约束 下 ， 对 有 障碍 存在 的 完备 性 及 最 优 规 
SU, MAMIE X= ROM A X = ROO) 双 积 
分 系统 。 为 研发 这 方面 的 算法 ， 通 常 需要 进行 一 些 离 


散 化 处 理 。 对 于 普通 运动 规划 ， 只 有 @ 需 要 离散 ， 对 
TRUMAN, 除了 C (或 X) 外 , TAU (可 能 ) 也 
需要 离散 化 。 

微分 约束 的 离散 化 是 最 重要 的 问题 之 一 。 为 了 有 
效 地 求解 具有 挑战 性 的 规划 问题 ， 通 常 需要 对 特定 的 
动力 学 系统 ， 定 义 运动 图 元 5“”%"。 对 微分 约束 进 
行 离散 ， 一 种 最 简单 的 方法 是 构造 离散 时 间 模型 ， 它 
具有 三 个 方面 的 特点 : 

1) 将 时 间 区 间 了 划分 为 长 度 为 Ai 的 时 间 间 隔 。 
这 样 时 间 就 分 成 多 个 阶段 ， 其 中 大 阶段 预示 (E - 1) 
Av 的 时 间 已 经 过 去 。 

2) 选择 动作 空间 U 的 一 个 有 限 了 集 Uso MUR U 
已 经 是 有 限 的 ， 则 可 选择 U, =U. 

3) 在 每 个 时 间 步 内 ,动作 wu(1) 必须 保持 为 
常数 。 

从 初始 状态 x 开始 ， 运 用 离散 动作 的 所 有 序列 ， 
形成 可 达 树 。 图 5. 12 显示 了 Dubins 车 上 这 种 树 的 路 
径 ， 它 是 一 个 小 车 的 运动 学 模型 ， 该 小 车 以 单位 速度 
在 平面 上 行驶 ， 且 不 能 反 向 运动 ， 树 的 边线 为 圆 弧 和 
线段 。 对 于 常规 系统 ， 当 w 给 定时 ， 树 上 的 每 个 轨迹 
Et, TIH x =/(x, u) 的 数值 积分 来 确定 。 通 常 这 可 
视 作 一 个 增 量 模拟 器 ， 它 获取 一 个 输入 后 ， 根 据 之 = 
f(x, u) 产生 一 个 轨迹 段 。 


2 阶段 4 阶段 
图 5.12 三 动作 Dubins 车 的 可 达 树 ， 
第 阶段 产生 34 个 新 顶点 


5.4.3 fik 

对 于 轨迹 规划 等 涉及 动力 学 的 问题 ， 流 行 的 算法 
是 先 将 问题 解 耦 为 路 径 规 划 ， 再 沿 着 路 径 计 算计 时 函 
数 ， 这 一 步 通过 对 (s, 5) 空间 跨 距 进行 搜索 来 实 
现 ， 其 中 * 是 路 径 参数 ，* 为 其 一 阶 导数 。 由 此 可 得 
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到 图 5. 13， 图 的 上 部 5S, 区域 是 必须 要 避免 的 ， 因 为 
其 上 机 械 子 系统 的 运动 违反 了 微分 约束 条 件 。 目 前 大 
多 数 方法 都 还 是 基于 文献 [5.68, 69] 等 早期 工作 ， 
用 来 确定 bang- bang 控制 ， 这 意味 着 要 在 全 速 下 进行 
加 速 和 减速 的 切换 。 一 旦 对 路 径 进 行 约束 ， 该 方法 可 
用 于 确定 时 间 最 优 轨 迹 。 此 外 ， 动 力学 规划 还 可 用 于 
SS] EE I p 。 
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图 5. 13 bang-bang 方法 计算 时 间 最 优 轨迹 ， 
通过 连接 图 上 的 点 得 到 求解 轨迹 


对 某 些 约束 问题 和 非 完 整 系统 ， 导 向 法 已 发 展 到 
可 用 于 有 效 求解 两 点 的 边 值 问题 5““ ”1 。 这 意味 着 
对 于 任意 的 状态 对 ， 可 以 获得 一 条 忽略 障碍 本 身 
足 微分 约束 的 运动 轨迹 。 此 外 ， 对 于 某 些 系统 ， 
得 到 了 最 优 轨 迹 特征 的 完备 集 *””。 这 些 基 于 控 
的 解 耦 方法 ， 能 直接 适用 于 基于 抽样 的 路 线 
TREE) ， 其 中 一 种 解 耦 方法 是 : 先 在 忽略 微分 约 
的 情况 下 ， 规 划 出 一 条 路 径 ， 然 后 逐渐 将 它 变换 为 满 
ARIES OP! 。 


(HU jn 
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5.4.4 kinodynamic 规划 


由 于 微分 约束 下 的 规划 难度 很 大 ， 因 此 许多 成 功 
的 基于 抽样 的 规划 算法 是 在 相 空间 下 上， 直接 处 理 
kinodynamic 问题 。 

基于 抽样 的 规划 算法 ， 通 过 对 一 个 或 多 个 可 达 树 
来 进行 搜索 ， 在 搜索 网 格 时 ， 可 画 出 许多 平行 线 。 但 
对 于 可 达 树 则 更 为 复杂 ， 因 为 它们 涉及 的 不 一 定 都 是 
规则 的 点 阵 结 构 。 大 多 数 情况 下 ， 在 可 达 树 的 顶点 位 
置 处 ， 点 会 非常 密集 ， 因 此 在 固定 分 辩 率 下 ， 无 法 
清晰 地 实现 对 有 界 区 域 的 详细 搜索 。 另 外 也 很 难 
设计 成 这 样 一 种 方法 ， 使 其 成 为 一 个 多 分 辨 率 网 
格 ， 其 精度 可 任意 调整 ， 以 确保 分 辩 率 的 完备 性 。 


许多 算法 尝试 将 可 达 树 转换 为 点 阵 形式 ， 这 正 是 
原始 kinodynamic 规划 工作 的 基础 十 2] ， 其 中 离散 时 
间 的 近似 二 重 积分 9 =&， 需 要 加 到 网 格 上 ， 如 图 
5.14 所 示 。 这 使 得 可 开发 一 种 近似 算法 来 求解 Kino- 
dynamic 规划 问题 ， 算 法 中 时 间 多 项 式 等 于 近似 量 
1/ e ， 并 采用 图 元 数 来 定义 障碍 物 。 对 于 全 驱动 系 
统 ， 普 适 化 的 方法 描述 见 参考 文献 [15.77]。 令 人 惊 
异 的 是 ， 该 方法 对 于 某 些 欠 驱 动 的 非 完整 性 系统 ， 甚 
至 也 能 得 到 点 阵 结构 号 ”1 。 


图 5.14 从 原点 开始 的 可 达 图 ， 经 过 3 个 阶段 后 的 示例 
( 当 加 速 或 减速 发 生 时 ， 真实 的 边线 将 是 抛物 线 ) 
(注意 虽然 得 到 了 点 阵 结构 ,但 在 第 一 阶段 


行进 距离 会 随 着 | q | 的 增加 而 增 大 ) 


如 果 可 达 树 不 能 形成 点 阵 ( 网 格 ) ， 一 种 方法 是 
强制 在 (BKC) 上 进行 规则 单元 分 解 ， 且 只 允许 每 
个 单元 的 一 个 点 通过 可 达 图 进行 扩展 ， 如 图 5.15 所 
示 。 参 考 文献 [5.78] 中 介绍 了 这 一 思想 ， 他 们 通 
过 动力 学 规划 ， 来 完成 可 达 图 的 扩展 。 每 个 单元 最 初 
标记 为 有 碰撞 或 无 碰撞 ， 但 并 不 访问 ; 当 搜索 中 访问 
单元 时 ， 也 要 这 样 进 行 标记 ; 如 果 一 个 新 顶点 落 入 到 
访问 过 的 单元 ， 将 不 被 保存 ; 这 具有 修剪 可 达 树 的 
效果 。 
其 他 相关 的 方法 并 不 强制 可 达 树 形成 网 格 。 快 速 
搜索 随机 树 (RRT) 方法 设计 为 用 这 样 的 方式 进行 
扩展 树 : 在 每 步 迭 代 中 ,偏向 尽 可 能 多 地 覆盖 新 区 
域 ， ”i。 基 于 扩展 树 概念 的 规划 ， 力 图 通过 分 析 邻 域 
来 控制 树 上 的 顶点 密度 人 。 有 向 路 径 细 分 树 规划 进 
行 扩展 时 ， 同 时 建立 状态 空间 的 自 适 应 分 割 ， 以 避免 
在 同一 空间 区 域 再 次 采样 5 T 。 这 些 方法 能 偏 于 加 
快 树 向 目标 的 扩展 ， 同 时 还 提供 了 弱 概 率 完备 性 
REP * 。 
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b) 


图 5.15 规则 单元 分 解 
a) Dubins 车 最 初 4 个 阶段 的 密集 可 达 图 b) 让 每 个 单元 至 多 只 有 一 个 顶点 ， 
剪 掉 许 多 分 支 后 ， 得 到 的 一 个 可 能 搜索 图 (本 例 中 没有 沿 9 轴 的 单元 分 离 ) 


5.5 扩展 与 变化 


本 节 简 要 回顾 基本 运动 规划 问题 的 一 些 其 他 重要 
的 扩展 。 


5.5.1 闭 式 运动 链 

在 许多 情况 下 ， 机 器 人 可 能 由 连 杆 通过 闭环 形式 
组 成 。 这 方面 有 许多 重要 应 用 ， 如 两 辟 抓 住 同一 个 物 
体 ， 则 形成 了 一 个 环 ; 又 如 人 形 机 器 人 双 脚 触 地 ， 也 
形成 一 个 环 。 对 于 并 联机 器 人 ,， 还 有 意 设计 成 
peu ， 其 经 典 的 例子 为 Stewart- Grough 平台 。 为 模 
拟 闭 链 问 题 ， 就 要 将 环 打开 以 便 得 到 连 杆 的 运动 树 。 
主要 的 复杂 性 是 C 上 引入 了 有 (gq) =0 形式 的 约束 ， 它 
要 求 对 环 进行 保留 ， 这 对 于 大 多 数 规划 算法 来 说 遇 到 
了 很 大 麻烦 ， 因 为 没有 环 的 C 参 数 是 可 用 的 。 闭 环 约 
东 只 能 将 规划 限制 在 无 给 出 参数 的 低 维 @ 子 集 上 ， 因 
为 计算 参数 一 般 很 困难 或 根本 不 可 能  ， 尽 管 对 某 
些 特殊 情况 ， 也 取得 了 一 定 进展 31。 

基于 抽样 方法 能 广泛 适用 于 处 理 封 闭 链 问题 。 其 
主要 困难 在 于 , CG 上 的 样本 a(i) 的 构 型 不 太 容 易 满足 
封闭 性 。 在 参考 文献 [5.84] 中 ，RRT 和 PRM 都 能 
适用 于 封闭 链 ， 而 RRT 更 好 ， 这 是 因为 在 PRM 中 ， 
将 样本 移 到 封闭 子 空间 时 ， 要 付出 较 高 的 优化 代价 ， 
而 RRT 不 需要 样本 进入 子 空间 。 对 于 参考 文献 
[5.85] 中 的 PRM 算法 ,将 链 路 解 克成 主动 链 和 被 
动 链 ， 接 下 来 通过 逆向 动力 学 计算 ， 能 极 大 地 提升 该 


方法 的 性 能 。 引 入 随机 闭环 发 生 器 (RLG) 后 ， 该 想 
法 得 到 了 进一步 的 改进 。 在 此 基础 上 ， 一 些 更 具 挑 战 
性 的 闭 链 规 划 问 题 ， 其 求解 方法 见 参考 文献 
[5.86], 


5.5.2 操作 规划 


在 大 多 数 形式 的 运动 规划 中 ， 机 器 人 是 不 允许 接 
触 障碍 物 的 。 假 设 改 为 期 望 通过 操作 对 象 与 环境 交互 
作用 ， 其 目标 可 能 是 将 物体 从 一 个 地 方 转移 到 另外 地 
方 ， 或 者 重新 对 目标 进行 整理 收集 ， 这 将 导致 出 现 一 
类 混合 运动 规划 问题 : 它 混合 了 离散 空间 和 连续 空 
间 。 离 散 模 式 对 应 于 机 器 人 是 否 正 在 搬运 部 件 
(part) ”1 ， 在 过 境 模式 中 ， 机 器 人 向 着 部 件 运 动 ， 
在 转移 模式 中 ， 机 器 人 搬运 部 件 。 两 种 模式 之 间 的 转 
换 需 要 满足 特定 的 抓 取 和 稳定 性 条 件 。 装 配 规划 是 一 
种 重要 的 操作 规划 的 变 体 ， 其 目标 是 将 各 个 部 件 安装 
在 一 起 ,使 之 成 为 一 件 装配 产品 。 大 部 分 运动 规 
划 工 艺 ， 都 对 机 器 人 与 对 象 之 间 的 各 种 交互 作用 ， 作 
了 限制 性 假设 。 更 为 丰富 的 操作 规划 模型 ， 参 见 参考 
文献 [5.89], 


5.5.3 时 变 问 题 


假设 工作 空间 包含 移动 障碍 物 ， 其 轨迹 为 时 间 的 
函数 。 设 TCR 表示 时 间 区 间 ， 它 可 能 有 界 ， 也 可 能 
无 界 。 状 态 站 定义 为 和 = Cx7T， 其 中 CC 就 是 通常 的 机 
ar A CB X BASES DB A 

Xas 71(4,0 eX|A(q) NOG) 70] 


(5.5) 
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SUP, @(1) 为 时 变 障 碍 。 许 多 规划 算法 均 适 用 于 义 ， 
它 只 比 @ 多 一 维 ， 问 题 的 主要 复杂 性 在 于 时 间 必 须 始 
终 沿 着 过 天 的 路 径 增 加 。 

对 这 个 问题 最 简单 的 算法 版 本 是 对 机 器 人 没有 

速度 限制 。 在 这 种 情况 下 ， 几 乎 所 有 的 基于 抽样 算 
法 均 适 用 ， 除 了 路 径 是 有 向 的 以 便 安 排 时 间 进 程 外 ， 
增 量 搜索 和 抽样 方法 也 几乎 不 加 修改 就 能 应 用 。 对 
于 时 变 问 题 ， 采 用 双向 方法 则 比较 困难 ， 因 为 由 于 
时 间 的 依赖 性 ， 目 标 通 常 不 是 一 个 不 动 的 单一 点 。 
基于 抽样 的 路 线 图 虽然 也 可 以 使 用 ， 但 需要 采用 有 
向 路 线 图 ， 其 中 必须 对 每 条 边线 定向 ， 使 其 产生 时 
间 单 调 路 径 。 
如 果 运 动 模型 是 代数 的 ( 即 表达 式 为 多 项 式 )， 
则 ,是 半 代 数 的 ， 它 可 以 采用 柱 形 代数 分 解 。 如 图 
5.16 所 示 ， 如 果 已 ,为 多 面体 ， 则 可 使 用 垂直 分 解 。 
最 好 是 先 沿 着 了 轴 扫 描 平 面 ， 当 线性 运动 改变 时 ， 则 
在 临界 时 间 上 停止。 


有 


Cfree (t5) 


Cree (ti) Cree (t2) 


图 5. 16 线性 障碍 运动 的 时 变 实例 


机 器 人 移动 避 障 问题 中 ， 迄 今 为 止 还 没有 对 速度 
加 以 考虑 。 显 然 如 果 求 解 结果 是 需要 机 器 人 以 任意 快 
的 速度 移动 ， 这 在 许多 应 用 中 并 不 合 切实 际 。 为 朝 着 
构造 现实 模型 发 展 ， 第 一 步 就 是 要 对 机 器 人 的 速度 做 
出 限制 ， 然 而 令 人 遗憾 的 是 ， 这 个 问题 相当 复杂 ， 即 
便 是 平面 障碍 的 分 段 线性 运动 ， 这 一 问题 的 难度 级 别 
已 属于 PSPACE-hard ^?! 。 此 外 ， 参 考 文献 【5.91 ] 
提出 了 基于 最 短路 径路 线 图 的 完备 性 算法 。 

种 替代 方案 是 将 问题 定义 在 ex7 E, 2H 
为 路 径 规划 部 分 和 运动 时 序 部 分 。 首 先 计算 缺少 障碍 
物 时 的 无 碰撞 路 径 规 划 ， 然 后 通过 对 路 径 确定 计时 函 
Be (时 间 尺 度 ) 完成 二 维 空间 的 搜索 。 


5.5.4 多 机 器 人 系统 


对 基本 运动 规划 问题 做 些 简单 扩展 ， 就 能 用 于 处 
理 包 括 自 相交 在 内 的 多 体 机 器 人 问题 ， 然 而 重要 的 是 
要 指定 刚体 对 之 间 哪 些 碰撞 是 不 能 接受 的 。 例 如 ， 机 
械 臂 的 连续 连 杆 则 是 允许 接触 的 。 
多 机 器 人 系统 的 运动 规划 问题 一 直 倍 受 关注 。 假 
设 有 m 个 机 器 人 ,同时 考虑 所 有 机 器 人 的 构 型 ， 其 
状态 空间 定义 为 : 
X2Q xxe (5.6) 
RE xe XG MAA AAW, RRN x = 
(4. die, a"), XMHERAN, HN = 
», ,dim(C) 。 
在 状态 空间 中 ， 障 碍 区 域 的 来 源 有 两 个 : OBL AE 
人 -障碍 物 碰撞 ; @ 机 器 人 -机 器 人 碰撞 。 对 每 个 让， 
Izixm, 在 与 障 但 区 域 @ 冲突 时 ， 对 应 于 机 器 人 A 
8 x TS 
Xi 2ixeX|A(q)n OZD) 
此 模型 属于 机 器 人 -障碍 物 碰撞 。 
对 机 器 人 的 每 对 A 和 hi, h 与 WW 冲突 时 ， 其 相应 
Hg X FENH 
Xi, -ixeX|A(q)n(q)s0)] (5.8) 
合并 式 (5.7) 和 式 (5.8) 到 式 (5.9), WAR x 
rP AS BE EX Sa XO 
x, (Ùx. Joss) 
一 旦 给 出 了 这 些 定义 ,任何 通用 的 规划 算法 都 可 
以 使 用 ， 因 为 除了 维 数 N RTBEAR Zh, X AX, Fi 
C 和 Cs 并 无 不 同 。 直 接 在 对 上 进行 规划 的 方法 称 为 
RR, X 的 高 维 问题 促进 了 解 看 方法 的 发 展 ， 用 于 对 
每 个 机 器 人 独立 规划 方面 的 问题 进行 处 理 。 解 耘 方法 
通常 更 为 有 效 ， 但 往往 以 牺牲 完备 性 为 代价 。 早 期 的 
解 看 方法 为 优先 规划 ”1 ， 其 中 在 对 第 i 个 机 器 人 
计算 路 径 和 计时 函数 时 ， 将 前 面 的 :=- 1 个 机 器 人 处 
理 为 沿 其 路 径 移 动 的 障碍 物 。 另 一 种 解 耦 方法 是 固定 
路 径 协调 方法 ， 它 对 每 个 机 器 人 独立 规划 路 径 ， 然 后 
通过 m 维 协调 空间 计算 无 碰撞 路 径 ， 再 确定 计时 函 
数 。 在 协调 空间 上 ， 每 个 轴 对 应 于 一 个 机 器 人 路 径 定 
义 域 ， 图 5. 17 为 一 个 示例 。 这 一 思想 已 被 推广 到 路 
线 图 的 协调 问题 中 ”1。 


5.5.5 预报 不 确定 性 


如 果 执 行 的 规划 是 不 可 预报 的 ， 则 需要 进行 反馈 
处 理 。 不 确定 性 可 模拟 为 隐 式 的 ， 意 味 着 规划 能 对 将 


(5.7) 


(5.9) 
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图 5.17 ”坐标 数 为 m 的 机 器 人 ， 其 障碍 空间 通常 
DER, SAL m(m +1 ) 个 轴 对 齐 的 二 维 
RE. ORT Xa 的 完备 性 特性 


来 未 预料 的 构 型 作出 响应 ; 或 者 为 显 式 的 ， 表 示 不 确 
定性 特点 已 在 规划 中 做 了 分 析 。 基 于 势 函数 的 方法 ， 
是 实现 反馈 运动 规划 的 一 种 方式 。 

规划 可 表示 为 Cre 上 的 一 个 矢量 场 ， 其 中 每 个 
矢量 表示 要 求 的 速度 。 矢 量 场 的 积分 曲线 在 不 离 
开 Cw 的 前 提 下 ， 应 该 流入 到 目标 上 。 如 果 与 动力 
学 有 关 ， 则 矢量 场 可 由 基于 加 速度 的 控制 模型 来 
追踪 : 


u-K(f(q)-4)*Vsf(q) (5. 10) 
式 中 , K 为 标量 形式 的 增益 常数 (放大 系数 ) 。 蔡 代 
地 ， 可 在 相 空 间 对 上 直接 设计 速度 场 , 但 在 一 般 条 
件 下 ， 还 没有 能 够 有 效 计算 这 种 场 的 方法 。 别 处 也 可 
以 将 反馈 控制 问题 考虑 为 带 有 隐 式 的 、 对 上 的 非 线 性 
AR, 
如 果 不 确 定性 模拟 为 显 式 的 ， 则 可 得 反 自 然 博弈 
问题 ， 其 中 由 特别 决策 者 引起 的 不 确定 性 称 为 自然 ， 
自然 的 决策 可 模拟 为 非 定常 的 ， 这 表示 指定 了 一 组 可 
能 的 动作 ; 或 者 为 概率 性 的 ， 这 表示 指定 了 自然 动作 
的 概率 分 布 (或 概率 密度 )。 在 非 定常 不 确定 性 下 ， 
通常 运用 最 坏 情况 分 析 来 选择 规划 ; 在 概率 不 确定 性 
下 ， 通 常 运用 期 望 情况 分 析 。 对 这 类 问题 的 分 析 方 法 
很 多 ， 其 中 包括 估 值 迭代 、Dijkstra-like 算法 ， 强 化 
SE EET, 


5.5.6 传 感 不 确定 性 


考虑 有 限 传 感 下 解决 定位 、 地 图 构建 、 操 作 、 
目标 跟踪 ， 以 及 追 逃 〈( 躲 猫 猫 ) 等 任务 。 如 果 在 执 
行 过 程 中 ， 当 前 构 型 或 状态 是 未 知 的 ， 则 问题 会 变 


得 非常 困难 。 从 传感器 获取 信息 ， 问 题 自 然 就 涉及 
到 信息 空间 (或 1 空间 ， 见 参考 文献 [5.7] 的 第 
11 章 )。 状 态 量 可 能 包括 构 型 、 速 度 甚 至 环境 地 图 
(如 障碍 物 ) 。 最 基本 的 1 空间 就 是 在 执行 过 程 中 获 
得 的 所 有 历史 数据 集 ， 这 些 数据 包括 所 有 传 感 观测 、 
以 前 的 动作 ， 以 及 初始 条 件 。 本 文 开 展 有 效 算法 的 
目的 ， 是 为 了 确定 信息 映射 ,从 而 减 小 I 空间 的 尺 
度 和 复杂 度 ， 以 便 在 采用 信息 反馈 进行 规划 时 便于 
计算 。 传 统 方式 采用 信息 状态 来 作为 估计 状态 ， 这 
对 于 许多 任务 的 求解 是 充分 的 ， 但 通常 是 不 必要 的 。 
有 可 能 设计 并 成 功 执行 一 项 规划 ， 而 甚至 不 用 知道 
当前 的 状态 ， 这 会 导致 出 现 更 多 的 鲁 棒 性 机 器 人 系 
统 ， 它 们 由 于 降低 了 传 感 要 求 ， 因 而 制造 成 本 会 更 
便宜 。 对 于 与 此 话题 相关 的 更 多 材料 ， 可 参阅 本 书 
第 3 篇 的 章节 。 


5.6 高 级 问题 


本 节 涵 盖 了 一 系列 更 加 高 级 的 问题 ， 例 如 拓扑 结 
构 和 抽样 理论 ， 以 及 它们 对 运动 规划 融 的 性 能 影响 。 
最 后 一 小 节 将 专门 讨论 代数 几何 计算 技术 ， 用 于 实现 
一 般 情况 下 的 完备 性 ， 而 不 是 讨论 实用 性 问题 ， 作 为 
一 个 上 界 ， 用 以 获取 最 佳 渐进 运行 时 间 。 


5.6.1 构 型 空间 的 拓扑 


1. 流 形 

C 空间 拓扑 重要 的 一 个 原因 是 它 影响 表示 法 ; 男 
一 个 原因 是 ， 如 果 路 径 规划 算法 能 在 拓扑 空间 求解 问 
题 ， 那 么 该 算法 可 结 转 到 拓扑 等 价 空间 上 。 

为 了 描述 C 空间 的 拓扑 ， 有 如 下 重要 定义 : 映 
Ko: 5 一 7 RCN (Bt), WAR AO, H. 
中 和 中” 都 连续 。 当 这 样 一 个 映射 存在 时 ，S$ 和 了 被 
称 为 是 同 胚 的 。 如 果 对 RR" 局 部 同 胚 ， 集合 $ 为 一 个 
n ARIE, KERS 上 的 每 个 点 拥有 一 个 邻 域 ,对 
R" 是 同 胚 的 。 更 多 详情 参见 参考 文献 [5.97, 98]. 

在 绝 大 多 数 运动 规划 问题 中 ， 构 型 空间 是 一 个 流 
形 。C 空间 不 是 流 形 的 例子 是 ， 封 闭 的 单位 正方 形 : 
[0, 1] x[0, 1] CR?,， 它 是 通过 将 一 维 边界 粘贴 到 
二 维 开 集 (0, 1) x (0, 1) 上 ， 而 得 到 的 一 个 带 边 
流 形 。 当 C 空间 是 一 个 流 形 时 ， 则 恰好 可 以 用 nn 个 参 
数 来 表示 它 ， 其 中 是 构 型 空间 的 维 数 。 尽 管 一 个 n 
维 流 形 可 以 采用 尽 可 能 少 的 个 参数 来 表示 ， 但 由 于 
约束 条 件 ， 它 可 能 更 方便 采用 高 维 参数 表示 法 。 例 
如 : 单位 圆 可 通过 将 SARAR’, KRNS = | (x, 
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2. 表示 法 
艇 入 到 更 高 维 的 空间 可 以 方便 C 空间 的 许多 操 
作 。 例 如 空间 中 刚体 的 姿态 (方位) 可 用 nxn 的 实 
数 矩 阵 表 示 ; 巡 矩 阵 必 定 满足 一 个 光滑 等 式 约束 数 ， 
使 得 这 个 矩阵 的 流 形 为 民 ”的 子 流 形 。 一 个 优点 是 这 
些 矩 阵 在 流 形 中 相 乘 得 到 另外 一 个 矩阵 ， 例 如 , n 
空间 (n=2 或 3) 中 刚体 的 姿态 可 用 SO(n) 描述 ， 
XE SO(n) 为 所 有 nxn 旋转 矩阵 的 集合 。 刚 体 的 位 
(位 置 和 姿态 ) 可 用 SE(n) E(n) 
UU nxn FRERE, HEMET HF: 
中 表示 刚体 构 型 ; @ 改 变 用 于 构 型 表示 法 的 坐标 系 ; 
@@ 置 换 构 型 。 
确定 SO(3) 参数 的 方法 很 多 ”1 , 但 当 用 SK 
示 二 维 旋转 时 ， 单 位 四 元 素 保 持 了 C 空间 的 拓扑 。 
四 元 素 已 在 第 一 章 做 过 介绍 ， 而 这 里 单位 四 元 素 和 三 
维 旋转 矩阵 间 有 一 个 2 对 1 的 对 应 关系 ， 这 使 得 拓扑 
问题 类 似 于 二 维 旋转 中 0 和 2 等 价 问题 ， 解 决 的 办 
法 是 申明 上 对 极点 是 等 价 的 。 在 规划 中 ， 只 有 S 
的 上 半球 是 需要 的 ， 而 且 穿 越 赤道 的 路 径 ， 瞬 间 会 重 
MERES 的 对 面 ， 回 到 北半球 。 在 拓扑 当中 ， 这 
PALS H: R mm。 因 此 三 维 物体 的 C 空间 上 ， 
只 有 转动 是 展 巴 。 如 果 平 动 和 转动 都 允许 ， 则 为 
SE(3), ， 即 所 有 4 x4 齐 次 变换 矩阵 ， 得 
Q-R^xR (5.11) 
它 是 6 维 的 。 构 型 ge C 可 采用 带 有 7 个 坐标 (x, y, z, 
a, b, c, d) 的 四 元 素 表示 ， 其 中 a +b xà) +d =1, 


m 


长 示 ， 这 里 
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EY DS 
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5.6.2 抽样 理论 


因为 现今 对 于 运动 规划 最 成 功 的 算法 都 是 5. 2 节 
提出 的 基于 抽样 的 构架 ， 抽 样 理论 已 成 为 运动 规划 的 
相关 问题 。 

1. 构 型 /状态 空间 中 的 和 矩阵 
事实 上 ， 所 有 基于 抽样 的 方法 ， 都 需要 在 C 上 定 
义 某 种 距离 。 例 如 ， 基 于 抽样 的 路 线 图 方法 ， 给 定 一 
个 用 距离 定义 的 邻 域 ， 选 择 候 选 顶 点 去 连接 一 个 新 构 


型 。 类 似 的 ， 快 速 搜索 密集 树 方法 ， 从 最 近 的 树 节 点 
将 树 扩展 到 一 个 新 的 样本 构 型 。 通 常 ， 定 义 一 个 度量 


p;Qx CR ， 它 满足 标准 公理 : 非 负 性 、 自 反 性 、 
对 称 性 和 三 角 不 等 式 。 

在 构建 度量 时 出 现 了 两 个 难题 : 四 C 的 拓扑 结构 
必须 遵守 ; @ 个 别 不 同 的 量 ， 如 线 位 移 和 角 位 移 ， 必 
须 以 某 种 方式 进行 比较 。 为 了 说 明 第 二 个 问题 ， 在 
Z = 下 xy 空间 上 ， 定 义 一 个 度量 p。， 


-2ep,(x, x') +ep,(y, y') (5.12) 


AF, cL 和 是 任意 的 正常 数 ， 代 表 两 个 分 量 的 相关 


权重 。 对 于 二 维 旋转 0,, FARK a, = cos0;, b, = sin0,， 
则 可 用 的 度量 为 
plai, bi, a, b) =cos (aa, & b,b,) (5.13) 


通过 如 下 定义 可 得 到 三 维 等 价 


po Rh, 


ET 


xh, 


min(p, (h, 
路 径 约 束 ， 


在 一 些 算法 


-Ei 


里 


, h,) =cos (aja, +bib, +¢,¢, +did,) 


(5.14) 


每 个 及 = (a;, bi, Ci, d;) 是 一 个 单位 四 元 素 。 
通过 各 自 的 双 极 点 辨识 ， 度 


a. 
H 


4E LA p(h,, h,) = 
QR, py (B, -h)) 。 对 于 单位 球 上 的 
可 在 R* 上 计算 最 短 距离 。 

Ph， 在 C 上 定义 体积 可 能 也 很 重要 。 
个 测度 空间 ， 对 每 一 个 体积 函数 


E 


引入 


这 通常 需 


( 称 为 测度 ) 必须 满足 类 似 于 概率 公理 的 这 样 一 些 公 


M, 但 不 需要 归 
样 的 方式 来 定义 
体积 称 作 Haar 1 


式 (5.14) 
一 关系 。 


一 化 。 对 于 每 个 变换 ， 必 须 仔 细 以 这 
体积 ， 即 它 关于 变换 为 不 变量 ， 这 个 
则 度 。 采 用 度量 的 定义 式 (5.13) 和 
， 通 过 球 来 定义 的 体积 ， 实 际 上 已 满足 这 


-EL 
里 


E 9 


pA 
Lo 


2. 概率 抽样 与 确定 性 抽样 


C 空间 的 抽样 可 分 为 概率 性 和 确定 怕 


哪 种 方式 ， 


E 两 种 。 无 论 
通常 需要 获得 一 个 样本 的 密集 序列 a， 这 


意味 着 作为 样本 数 的 限定 值 趋 于 无 穷 大 时 ， 样 本 任意 


接近 C 中 的 点 。 对 于 概率 怕 


E 抽 样 ， 这 个 密集 性 (以 概 


率 1) 确保 了 规划 算法 的 概率 完备 性 。 对 于 确定 性 抽 


样 ， 它 确保 了 分 辨 率 完 备 性 。 这 意味 着 如 到 
TEE ER il 


下 去 。 


对 于 概率 抽样 ， 使 
随机 选择 样本 。 要 通过 有 意 


该 采用 Ha 
而 SO(3) 


RETE TE, 


能 能 会 一 直 运行 


上 BE 


找到 它 ， 和 否则 算法 可 


均匀 概率 密度 函数 ， 在 C 上 
到 的 方式 获得 均匀 性 ， 应 
ar 测度 ， 这 在 许多 情况 下 是 简单 直接 的 ， 
TU RPA, SAE (SEF Haar 测度 ) 


随机 四 元 素 可 通过 如 下 方式 选择 : 随机 地 选择 三 个 点 


Uy, Uy, u, e[0, 1], 4 


h= 


HA 
( /l-u,sin2zgu,, ./l-u,cos27u,, 


A/u,sin2vru, , A/u,cos2Tu. ) (5.15) 


虽然 随机 样本 在 某 种 意义 上 是 均匀 的 ， 但 它们 也 


需要 有 一 些 
样 方案 的 发 


定性 抽 
代 随 机 性 上 


毕 不 规则 性 ， 以 满足 统计 检验 。 这 促进 了 确 
展 ， 以 提供 更 好 的 性 能 “"。 取 
的 确定 性 抽样 技术 则 在 优化 标准 ， 例 如 偏差 


ELIGE 


B. 


2: EE PE, EAI Z HL BL 


会 给 数值 积分 带 来 麻烦 ; 离 差 给 出 了 最 大 空 球 (不 
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含 样本 ) 的 半径 ， 这 样 ， 离 差 快速 回落 表示 整个 空 
间 迅 速 搜 索 。 确 定性 搜索 可 能 是 不 规则 的 邻 域 结构 
(出 现时 很 像 随机 抽样 ) ， 或 者 为 规则 的 邻 域 结构 
表示 点 沿 网 格 或 格 点 排列 。 更 详细 的 运动 规划 相关 介 
绍 ， 参 见 参考 文献 [5.7] 。 


5.6.3 代数 几何 计算 技术 


基于 抽样 的 算法 ， 具 有 和 良好 的 实用 性 ， 这 只 是 在 
付出 较 弱 完备 性 代价 下 就 实现 了 。 男 一 方面 ， 完 备 性 
算法 是 本 节 的 焦点 ， 它 能 推断 出 规划 问题 的 无 解 
情况 。 
只 要 CEC 用 代数 表面 的 曲面 片 (patch) 来 表示 ， 
完备 性 算法 就 能 解决 几乎 所 有 的 运动 规划 问题 ， 从 
形式 上 讲 ， 该 模型 必须 是 半 代 数 的 ， 这 意味 着 它 由 
q 上 变 元 多 项 式 根 的 并 集 和 交集 组 成 ， 且 为 了 可 计 
算 性 ， 多 项 式 系数 必须 为 有 理 数 (否则 根 可 能 无 有 
限 表 达 )。 具 有 有 理 系 数 的 多 项 式 ， 其 所 有 根 的 集合 
称 为 实 代 数 数 ， 它 具有 很 多 好 的 计算 性 能 。 关 于 实 代 
数 数 的 精确 表示 和 计算 ， 更 多 信息 见 参考 文献 
[5. 12, 102-104] ， 对 于 代数 几何 的 介绍 见 参 考 文献 
[5.82]. 
采用 基于 代数 几何 的 技术 ， 第 一 步 是 将 模型 转换 
成 为 所 需 的 多 项 式 。 假 如 模型 中 的 机 器 人 和 障碍 物 
GO 都 是 半 代 数 的 〈 这 包括 多 项 式 模型 ) ， 对 于 任何 附 
加 于 二 维和 三 维 构件 数 ， 运 动 变换 可 以 用 多 项 式 表 
示 。 由 于 多 项 式 变换 后 ， 产 生 的 还 是 多 项 式 ， 故 变换 
后 的 机 器 人 模型 仍 为 多 项 式 。 通 过 仔细 考虑 所 有 的 接 
触 类 型 ， 计 算出 由 Cw 组 成 的 代数 表面 ， 这 里 机 器 人 
特征 (表面 、 边 线 、 顶 点 )， 要 与 障碍 物 特征 配 
对 5793.%]， 在 大 多 数 应 用 中 ， 这 一 步 往往 会 产生 过 
多 的 模型 图 元 。 


于 图 5.7 的 垂直 分 解 ， 因 为 那里 的 射线 只 要 延伸 
至 找到 下 一 个 障碍 物 即 止 ， 而 这 里 是 为 了 获得 单 
元 柱 。 


R 
a) 


图 5.18 立柱 单元 的 二 维 例子 
a) 具有 四 个 图 元 的 人 脸 模型 b) 脸 部 的 柱 形 代 数 分 解 


pre 相交 


图 5.19 当 垂 直方 向 有 表面 折 释 或 者 表面 相交 时 ， 
就 会 出 现 临 界 点 


在 n 维 中 ,每 个 柱 ( 列 ) 表示 一 个 单元 链 ， 第 
一 个 和 最 后 一 个 单元 是 n 维 的 旦 无界， 剩余 的 单元 是 
都 有 界 的 ， 并 在 n -—1 ABAD n SETAC, AFL n 维 单 
元 的 上 下 界 ， 由 单一 多 元 多 项 式 的 根来 确定 ， 这 使 得 
对 单元 及 其 连接 性 的 描述 变 得 简单 。 为 计算 这 样 的 单 


一 旦 得 到 了 半 代 数 表 示 ， 就 能 使 用 来 自 代数 几何 
的 强力 技术 。 其 中 最 知名 的 算法 是 柱 形 代 数 分 
fappl® 102108107) ， 它 提供 了 求解 运动 规划 问题 所 需 的 信 
息 。 此 方法 的 最 初 目 的 是 用 来 确定 是 否 Tarski sen- 
tences (它们 涉及 计量 和 多 项 式 ) 可 以 满足 并 找到 一 
个 不 涉及 计量 的 等 价 表 达 式 。 柱 形 代数 分 解 生成 的 单 
元 有 限 集 ， 其 中 多 项 式 的 符号 保持 不 变 。 这 种 方法 系 
统 地 实现 了 条 件 满足 和 计量 消除 ， 它 经 过 schwartz 和 
sharir ^ 10%] E. 可 用 于 求解 运动 规划 问题 。 

该 方法 概念 简单 ， 但 在 技术 细节 上 还 有 许多 困 
难 。 称 为 柱 形 分 解 ， 是 因为 此 处 的 单元 都 构 织 成 垂 
直 的 立柱 单元 ， 其 二 维 例子 如 图 5. 18 所 示 。 如 图 
5.19 所 示 ， 有 两 种 类 型 的 临界 同 相 轴 ， 在 临界 点 上 


元 分 解 ， 算 法 需要 构建 一 个 投影 的 级 联 链 。 在 第 一 
CMR" REAR, BE POEIERL SIR", ox 
样 重复 直到 得 到 RR ， 它 为 带 有 一 个 单 变量 的 多 项 式 ， 
并 在 所 有 临界 边界 设置 位 置 编码 ; 在 算法 的 第 二 阶 
段 ， 进 行 一 系列 的 提升 ， 每 次 提升 都 在 R 上 获取 多 
项 式 和 单元 分 解 ， 并 将 其 通过 单元 柱 提 升 到 R"*'。 
单个 提升 的 示例 见 图 5. 18b。 整 个 算法 的 运行 时 间 ， 
取决 于 用 来 执行 代数 计算 的 具体 方法 。 总 的 运行 时 
间 ， 需 要 对 运动 规划 使 用 柱 形 代数 分 解 ， 边 界 为 
(md) 9", FEP m 为 描述 eu 的 多 项 式 数 (一 个 大 
ZO, d 为 最 大 代数 次 数 。( 它 看 似 对 OC +) 为 奇数 ， 
并 出 现在 表达 式 的 中 间 。 在 本 文 情况 下 ， 它 表示 存在 
某 个 ce [0，%w ) ,使 运行 时 间 在 (md)” 上 有 界 ， 注 


射线 束 朝 两 个 垂直 方向 无 限 延长 。 这 里 的 分 解 不 同 


意 整个 公式 前 面 的 另外 一 个 0 并 非 必 须 。) 需要 记 住 
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的 最 主要 一 点 是 , 算法 在 C 的 维 数 上 是 双 指 数 (甚至 


单元 数 也 是 双 指 数 ) 的 。 


虽然 执行 柱 形 分 解 对 于 解决 运动 规划 是 充分 的 ， 


但 与 必要 性 相 比 ， 它 计算 了 更 多 的 信息 ， 这 也 促使 了 
Canny 路 线 图 算法 的 出 现 521 。 该 算法 直接 通过 半 代 


数 集 产 生路 线 图 ， 而 不 通过 沿路 构建 单元 分 解 ， 


在 术 


因为 


和 主 形 代数 分 解 中 ， 有 许多 双 指 数 单元 ， 为 消除 这 种 


结构 需要 支付 代价 。 而 通过 Canny 路 线 图 方法 得 到 的 
结果 ， 在 时 间 上 求解 运动 规划 问题 时 ， 无 论 多 项 式 数 
还 是 多 项 式 代数 次 数 ， 都 还 是 一 个 多 项 式 ， 但 在 维 数 


上 仅 是 单 指数 的 。 


算法 的 基本 思想 是 ， 对 民 " 中 的 Cn, REER? 


上 的 轮廓 线 ， 即 通过 该 方法 找到 零 维 的 临界 点 和 一 维 


的 临 


界 曲线 。 临 界 曲线 为 路 线 图 的 边线 ， 临 界 点 为 


Cu 上 (n-1) 维 的 曲面 片 ， 通 过 递归 算法 得 到 的 影 
像 点 ， 这 样 会 贡献 更 多 的 临界 点 和 临界 曲线 。 该 曲线 
被 添加 到 路 线 图 中 ， 算 法 再 次 在 临界 点 上 递归 ， 直 到 
TRUE TCE n =2 时 中 止 。Canny 的 结果 表明 ， 临 界 


HAMAS, WIT Cos 〈 并 因此 也 保护 了 Cree) 的 
连接 性 。 面 临 的 一 些 技术 问题 是 : 中 算法 只 对 Cos B 


分 层 进入 流 形 起 作用 ; @ 算 法 具有 很 强 的 一 般 位 置 
假设 ， 以 至 于 很 难 满足 ; 加 路 径 实 际 上 是 沿 着 Cre 
的 边界 来 考虑 的 ; 由 此 方法 不 能 产生 参数 化 的 求解 
路 径 。 对 于 Canny 算法 及 其 他 重要 的 细节 改进 ， 见 
参考 文献 [5. 102] 。 


5.7 


结论 与 扩展 阅读 


我 们 在 本 章 简要 纵览 了 运动 规划 问题 ， 这 是 一 个 


FF 富 而 活跃 的 研究 领域 。 更 多 详情 ， 推 荐 两 本 新 书 供 


Fr 


读者 参考 (参考 文献 [5. 5，7]) ， 也 可 以 查阅 一 些 
经 典 的 论文 和 书籍 (参考 文献 [5.4，6]) ， 以 及 近 
来 的 研究 成 果 (参考 文献 [5.2，3])， 此 外 还 可 参 
考 本 章 罗列 的 相关 手册 章节 。 
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本 音 将 聚焦 于 机 器 人 刚性 机 械 辟 的 运动 控制 。 6.3.1 基于 单 关节 模型 的 控制 器 设计 een 111 
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械 辟 的 运动 控制 问题 中 ， 主要 的 挑战 在 于 动力 学 6.4 PID 控制 ee 112 
和 不 确定 性 带 来 的 复杂 性 。 前 者 是 由 机 器 人 机 械 6.4.1 调节 的 PD 控制 ee 113 
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满足 : 
6.1 运动 控制 简介 IT«(4) lg, (6.5) 
5. 性 质 6.5 
运动 方程 在 惯性 参数 中 都 是 线性 的 ， 即 有 一 个 


本 章 将 回顾 机 械 臂 的 动力 学 模型 ， 并 着 重 强调 它 
在 控制 器 设计 中 一 些 非常 有 用 的 重要 性 质 ， 最 后 将 定 
义 机 械 臂 不 同 的 控制 任务 。 


6.1.1 动力 学 模型 


对 于 运动 控制 ， 刚 性 机 械 辟 的 动力 学 模型 可 以 由 拉 
格 朗 日 动力 学 方程 简便 地 表示 出 来 。 设 机 械 辟 有 个 连 
Fr, 关节 变量 的 (n x1) 维 向 量 g 为 q =[g,…， 
gq,] 。 机 器 人 机 械 臂 的 动力 学 模型 可 由 拉 格 朗 日 方程 
RREI, 

H(q)q +C(q,q)q+t(q)=T (6.1) 

IF, H(q) 是 (nxn) 维 的 惯性 和 矩阵，C(qg，I)7 
是 科 里 奥 利 力 和 离心 力 的 (n x 1) 维 向 量 ; Ts (4) 
是 重力 的 (n x1) 维 向 量 ; z 是 竺 设计 的 关节 控制 
输入 的 (nx1) 维 向量 。 在 此 忽略 摩擦 和 扰动 
输入 。 

备注 : 

其 他 有 助 于 机 器 人 机 械 臂 动力 学 描述 的 方面 可 能 
还 有 驱动 器 动力 学 、 关 节 和 连 杆 柔性 、 摩 擦 、 品 声 和 
扰动 。 这 里 在 不 失 一 般 性 的 情况 下 ， 强 调 了 刚性 机 械 
臂 的 情况 。 

本 章 我 们 将 介绍 基于 一 些 机 器 人 机 械 辟 动力 学 模 
型 重要 性 质 的 控制 方案 。 在 详细 描述 各 种 不 同 的 控制 
方案 之 前 ,我 们 先 列 出 这 些 性 质 。 

1. 性 质 6.1 

惯性 矩阵 是 一 个 对 称 的 、 正 定 的 矩阵 ， 可 表 
ANA 


=, 


AL, <H(q) «AM, 
XUB, A, AA, 表示 正常 数 。 
2. 性 质 6.2 
AEMEN(q, qQ)  H(q) -2C(q, 4) 对 于 一 个 
特定 选取 的 CCg，4 ) (总 是 可 能 的 ) 是 反对 称 的 。 即 
对 于 任意 一 个 (n x1) 的 向 量 , z A: 
z N(q, q)z=0 


(6.2) 


(6.3) 
3. 性 质 6.3 
对 于 某 个 特定 的 有 界 常 数 C. (nxn) AE KE 
C(q, q) 满足 : 
lC, 4) [c.l a I 
4. 性 质 6.4 
对 于 一 个 特定 的 有 界 常数 s. 重力 / 转 矩 问 量 


(6.4) 


(rx1) 维 的 常数 向 量 a 和 一 个 (n xr) SEA BIA 
EY, q, q), IEI: 
H(q) 9 +C(q, q)q *T:(q) -Y(q, 9, q )a 
(6.6) 
AP, HE a 是 由 连 杆 的 质量 、 惯 性 矩 和 连 杆 的 各 种 
组 合 组 成 的 。 
6. 性 质 6.6 
映射 Tg 是 被 动 的 ; 亦 即 ， 存 在 a 二 0， 使 得 
[IBEBE -a Vi<w (67) 
备注 : 

1) 性 质 6.3 和 性 质 6.4 非常 有 用 ， 它们 让 我 们 
可 以 确定 动力 学 模型 中 非 线 性 项 的 上 界 。 正 如 我 们 可 
以 进一步 看 到 的 ， 好 多 控制 方案 都 需要 这 些 关 于 上 界 
的 知识 。 

2) 在 性 质 6.5 中 ， 参 数 向 量 a 是 由 多 个 变量 的 
各 种 组 合 构成 的 。 该 参数 空间 的 维度 不 是 唯一 的 ， 在 
参数 空间 中 的 搜索 是 一 个 重要 的 问题 。 

3) 在 这 一 节 里 ,我 们 假设 机 械 辟 是 完全 了 驱动 
的 ， 这 意味 着 对 于 每 个 自由 度 都 有 一 个 独立 控制 的 输 
入。 相反 ， 有 柔性 关节 或 者 柔性 连 杆 的 机 械 辟 不 再 是 
完全 驱动 的 ， 且 它们 的 控制 问题 一 般 而 言 会 更 加 
困难 。 


6.1.2 控制 任务 


出 于 比较 研究 的 目的 ， 将 控制 对 象 分 成 以 下 两 类 
是 有 益 的 : 

(1) 轨迹 跟踪 ”其 目的 是 在 一 定 的 工作 空间 内 
跟踪 关节 随时 间 变 化 的 参考 轨迹 。 一 般 而 言 ， 我 们 假 
设 期 望 的 轨迹 与 驱动 噩 的 能 力 范围 一 致 。 亦 即 ， 与 期 
望 的 轨迹 有 关 的 关节 速度 与 加 速度 应 该 分 别 不 超过 其 
机 械 臂 的 速度 与 加 速度 的 极限 。 在 实际 情况 下 ， 了 驱动 
器 的 能 力 是 由 转 和 矩 的 极限 决定 的 ， 这 使 得 复杂 且 状 态 
相关 的 加 速度 是 有 界 的 。 

(2) 调节 有 时 也 叫 点 对 点 控制 。 首 先 在 关节 
空间 里 指定 一 个 固定 的 参数 设置 ， 目 标 是 使 关节 的 变 


量 能 保持 在 期 望 的 位 置 ， 不 受 转 和 矩 扰动 的 影响 而 独立 
于 初始 状态 。 一 般 而 言 瞬 态 和 超 调 行为 都 是 无 法 确 
定 的 。 


控制 器 的 选择 依赖 于 所 要 执行 的 控制 任务 的 
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类 型 。 例 如 ， 只 需要 机 械 臂 从 一 个 位 置 移动 到 另 
外 一 个 位 置 而 对 这 两 点 间 的 运动 过 程 的 精度 没有 
特别 高 的 要 求 的 控制 任务 可 以 由 调节 来 完成 ， 而 
在 一 些 其 他 的 任务 中 ， 如 焊接 、 喷 漆 等 则 需要 跟 
踪 控 制 。 

备注 : 

1) 调节 问题 是 跟踪 问题 的 一 个 特例 (期望 的 关 
节 速 度 和 加 速度 都 为 零 ) 。 

2) 在 关节 空间 中 给 出 以 上 的 任务 说 明 ， 就 出 现 
了 关节 空间 控制 。 这 是 本 章 的 主要 内 容 。 有 时 ， 以 末 
端 执行 器 的 期 望 轨迹 所 做 的 机 器 人 机 械 臂 的 任务 说 明 
(如 手眼 控制 ) 是 在 任务 空间 进行 的 ， 并 引起 操作 空 
间 的 控制 ， 这 将 在 6. 2 节 介 绍 。 


小 结 


6.1.3 
在 这 一 他 ， 我 们 介绍 了 机 器 人 机 械 臂 的 动力 学 模 


型 及 其 重要 性 质 ， 而 且 定 义 了 机 需 人 机 械 臂 不 同 的 控 
制 任务 。 


6.2 关节 空间 与 操作 空间 控制 


在 运动 控制 问题 中 ， 机 械 辟 移动 到 一 个 位 置 拿 到 
一 个 物体 ， 将 其 运送 到 男 一 个 位 置 并 放下 它 ， 这 样 一 
个 任务 是 任何 一 个 更 高 级 别 操作 任务 如 喷漆 或 点 焊 的 
一 部 分 。 

任务 通常 是 以 在 任务 空间 上 未 端 执 行 器 期 望 的 轨 
迹 来 指定 的 ， 而 控制 操作 是 在 关节 空间 进行 的 ， 以 达 
到 期 望 的 目标 。 这 一 事实 自然 而 然 地 引出 了 两 种 一 般 
的 控制 方法 ， 即 关节 空间 控制 和 操作 空间 控制 〈 任 
务 空间 控制 ) 。 


6.2.1 关节 空间 控制 


关节 空间 控制 的 主要 目标 是 设计 一 种 反馈 控制 
器 ， 它 使 关节 坐标 系 g(1) e R" 尽 可 能 精确 地 跟踪 期 
望 运动 qu(1)。 为 此 ， 考 虑 关节 空间 ”中 一 个 n 个 
自由 度 机 械 臂 的 运动 方程 式 (6.1)。 在 这 种 情况 下 ， 


小 ， 使 机 械 臂 沿 着 关节 坐标 系 中 定义 的 期 望 轨迹 移 


动 [6.1,4,7,8] 


图 6.1 关节 空间 控制 的 广义 概念 


机 械 臂 4 


由 于 通常 都 会 假定 期 望 的 任务 是 按 关节 运动 的 时 
间 顺 序 给 出 的 ， 所 以 关节 空间 控制 方案 在 机 械 臂 任务 
精确 计划 过 ， 并 且 很 少 或 者 不 需要 进行 在 线 轨 迹 调整 
的 情况 下 就 足够 了 "” 。 典 型 地 ， 逆 运动 学 被 应 
用 于 计算 一 些 中 间 任 务 点 ， 并 且 关 节 的 运动 轨迹 可 以 
进行 中 间 插 补 。 尽 管 指令 轨迹 是 在 未 端 执行 器 坐标 系 
搬入 点 之 间 的 直线 运动 ， 但 最 终 的 关节 运动 轨迹 是 由 
插入 点 中 符合 期 望 的 末端 执 行 咒 运动 轨迹 的 曲线 部 分 
组 成 。 

实际 上 ， 关 节 空 间 控制 包括 简单 的 PD 控制 、 
PID 控制 、 逆 动力 学 控制 、 李 雅 普 诺 夫 控制 和 被 动 控 
制 。 这 些 控 制 方案 都 将 在 下 文中 进行 介绍 。 


6.2.2 操作 空间 控制 


在 更 加 复杂 和 确定 性 较 小 的 环境 中 ,末端 执行 
器 的 运动 会 服从 在 线 修 正 以 适应 不 可 预期 的 情况 出 
现 或 是 对 传感器 输入 进行 响应 。 这 类 控制 问题 存在 
于 生产 制造 过 程 的 各 种 任务 中 。 尤 其 是 当 需 要 考虑 
机 械 臂 与 工作 环境 的 交互 作用 时 ， 这 类 情况 都 会 
出 现 。 
由 于 期 望 任务 通常 会 在 操作 空间 中 定义 ， 并 且 需 
要 对 末端 执行 器 的 运动 进行 精确 控制 ， 所 以 关节 空间 
控制 在 上 述 情况 下 并 不 合适 。 这 就 产生 了 一 种 新 方 
法 ， 它 可 以 直接 根据 操作 空间 中 表示 的 动力 学 给 出 控 
制 方案 。 

设 雅 可 比 矩 阵 为 J(g) ER”, 根据 式 (6.8) 将 
关节 速度 (q eR") 转化 为 任务 速度 (x eR), 

x -J(q)q (6.8) 


机 器 人 机 械 臂 的 控制 很 自然 地 在 关节 空间 中 得 到 ， 因 
为 控制 输入 就 是 关节 的 转 矩 。 尽 管 如 此 ， 当 使 用 者 以 
末端 执行 器 坐标 系 定义 一 个 运动 时 ， 仍 有 必要 了 解 以 
下 方法 。 

图 6. 1 所 示 为 关节 空间 控制 方法 的 略图 。 首 先 ， 
通过 未 端 执行 咒 坐 标 系 描述 的 期 望 运动 被 转化 为 对 
应 的 关节 运动 轨迹 ， 这 一 过 程 是 通过 运用 机 械 臂 的 
道 运动 学 方程 实现 的 。 然 后 ， 反 馈 控制 絮 通 过 测量 
机 械 辟 当前 的 关节 状态 ,会 确定 需要 的 关节 转 矩 大 


FEH, 假设 它 是 可 道 的 。 那 么 ， 操 作 空 间 的 动力 学 就 
可 由 下 式 表示 : 

f.=A(q) x «I(q,q)x*n(q) (6.9) 
st, f, enm" 是 操作 空间 的 指令 力 ， 伪 惯性 矩阵 由 下 
EX: 


A(q) 2J (4) H(q)J Ca) 
FEH, 4) 和 w(g) 由 下 式 给 出 : 
I(q.4) -J (4)C(q.4)J (q) -A(q)J(q2)J (4) 


(6. 10) 
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nlg) =J '(q)t«(q) 

任务 空间 变量 通常 由 关节 空间 变量 通过 运动 学 映 
射 重建 。 事 实 上 ， 我 们 很 少 使 用 传感器 直接 测量 末端 
执行 器 的 位 置 与 速度 。 同 时 值得 注意 的 是 ， 因 为 控制 
方案 直接 作用 于 任务 空间 量 ， 如 末端 执行 器 的 位 姿 ， 
此 处 通常 会 使 用 一 个 分 析 雅 可 比 矩 阵 。 
操作 空间 控制 的 主要 目标 是 设计 一 种 反馈 控制 

它 可 以 执行 末端 执行 器 的 运动 x(1) eR, 该 运 
动 会 尽 可 能 准确 地 跟踪 期 望 的 末端 执行 器 运动 zx, (1) « 
为 此 ， 考 察 操作 空间 下 给 出 的 机 械 臂 运动 方程 
(6.9) 。 对 于 这 种 情况 ， 图 6. 2 给 出 了 操作 空间 控制 
方法 的 示意 图 。 该 方法 有 不 少 优点 ， 因 为 操作 空间 控 
制 器 采用 了 一 个 反馈 控制 闭环 ， 可 以 直接 最 大 限度 地 
减 小 任务 误差 。 由 于 控制 算法 能 入 了 速度 级 的 正和 运动 
学 式 (6.8)， 因 此 不 需要 精确 的 逆 运 动 学 计算 。 这 
样 ， 点 与 点 之 间 的 运动 就 可 以 表示 为 任务 空间 的 直线 
线段 


= 


图 6.2 操作 空间 控制 的 基本 概念 


6.3 独立 关节 控制 


独立 关节 控制 (如 ， 分 散 控制 ) 是 指 每 个 关节 
的 控制 输入 只 取决 于 相应 的 关节 位 移 与 速度 大 小 的 控 
制 方式 。 由 于 它 的 简单 结构 ， 这 种 控制 方式 具有 许多 
优点 。 例 如 ， 通 过 独立 关节 控制 ， 可 以 省 去 各 个 关节 
之 间 的 联系 。 此 外 ， 因 为 控制 器 的 计算 量 可 以 减 小 ， 
所 以 在 实际 应 用 中 低 成 本 的 硬件 就 可 以 满足 要 求 。 由 
于 所 有 关节 的 控制 器 都 有 相同 的 构成 ， 因 而 独立 关节 
控制 具有 可 扩展 的 特点 。 本 节 将 介绍 两 种 独立 关节 控 
制 方法 : 一 种 着 眼 于 各 关节 的 运动 学 模型 (如, m 
关节 模型 ) 的 分 析 ， 另 一 种 着 眼 于 整体 运动 学 模型 
(如 ， 多 关节 模型 ) 的 分 析 。 


6.3.1 基于 单 关节 模型 的 控制 器 设计 


最 简单 的 单一 关节 控制 策略 就 是 将 每 个 关节 轴 
作为 单 人 单 出 (SISO) 系统 来 控制 。 由 于 关节 运动 
中 不 同 设置 所 产生 的 关节 之 间 的 耦合 效应 可 以 被 视 
为 扰动 输入 。 不 失 一 般 性 ， 将 驱动 器 看 作 是 直流 旋 
转 电动 机 。 因 此 ， 关 节 的 控制 方案 的 框图 可 在 复 
变 函 数 域 中 表示 ， 如 图 6.3 所 示 。 在 这 种 控制 方案 


中 ,9 表示 电动 机 的 角 变 量 ,，J 表示 从 电动 机 来 看 的 
有 效 惯性 ，R, 是 电 枢 电阻 (忽略 自 感 ), k 和 ,分 
别 表示 转 和 矩 与 电动 机 常数 。 此 外 ，G, 表示 功率 放大 
器 的 电压 增益 ， 这 样 就 确定 了 参考 输入 是 放大 器 输 
入 电压 值 V, 而 不 是 电 枢 电压 V。 也 可 以 假定 Fp << 
kkAR,， 即 机 械 (AKE) 摩擦 系数 与 电 系 数 相 比 可 
以 忽略 。 现 在 ， 电 动机 的 输入 -输出 传递 函数 可 由 下 


式 表示 : 
k m 
MG) = (6.11) 
IP, ka= Gk, 和 了 = RJ/k k, 分 别 表示 电压 - 速 


度 增益 及 电动 机 的 时 间 常 数 。 


图 6.3 关节 驱动 系统 框图 (来 自 参考 文献 [6.4] ) 


要 帮助 控制 结构 的 选取 ， 首 先 要 注意 与 输出 角 0 
有 关 的 有 效 抑制 扰动 d 由 以 下 两 点 确定 : 

1) 扰动 的 插 补 点 前 有 大 的 放大 器 值 。 

2) 控制 器 中 积分 作用 的 存在 ， 用 以 消除 稳定 状 
态 时 输出 的 重力 分 量 效应 ( 如， 常数 0) 。 

这 种 情况 如 图 6. 4 所 示 ， 上 有 具有 位 置 和 速度 反馈 的 


控制 操作 类 型 由 图 6.4 来 表示 。 
G,(s) =K,, G,(s) 2 K, 


X, 6) A60) PRIMED Sue 的 控 
制 操作 。 值 得 注意 的 是 ， 内 部 控制 操作 G (s) Æ 
例 积分 (PI) 控制 的 一 种 形式 ， 它 是 定 值 扰动 为 d 
时 稳 状 态 中 的 零 误差 。 此 外 ，kis 和 hiv 都 是 传感器 
常数 ， 并 且 放 大 器 增益 Ky 已 被 徐 入 内 部 控制 器 


1+sT, 


(6. 12) 


增益 。 
在 图 6.4 中 ， 前 向 路 径 和 返回 路 径 的 传递 函数 分 
别 为 式 (6.13) 和 式 (6.14): 
k, K, Ky (1 +sT,) 
P(s) = s(1+sT,,) (6. 13) 
kw 
H(s) -hn (1+s EE ) (6.14) 


在 ;= -1/T, 时 ， 可 以 选择 控制 器 的 零点 以 消除 
在 s= -1/7, 时 电动 机 真正 电极 的 影响 。 然 后 ， 令 


7T, =7,， 则 在 根 轨迹 上 移动 的 闭环 系统 的 极点 可 以 
作为 闭环 增益 的 函数 ,kyhry。 通 过 增加 反馈 增益 


K,， 可 以 将 闭环 的 极点 限制 在 一 个 有 大 的 绝对 值 实 部 
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图 6.4 位 置 与 速度 反馈 框图 (来 自 参考 文献 [6.4] ) 


的 复 平面 域内 。 这 样 ， 通 过 选择 适当 的 Ky 就 可 以 确 
定 实际 位 置 。 
闭环 输入 输出 传递 函数 为 


s) krp 
)^ ks E (6.15) 


"ks Rk 
此 函数 可 与 典型 的 二 阶 系统 的 传递 函数 相 比 


W(s) =— = (6.16) 


可 以 看 出 ， 通 过 选择 适当 的 增益 ， 可 以 得 到 任何 
自然 频率 值 w, 和 阻尼 比 5。 所 以 ， 如 果 给 出 o, 和 
作为 设计 规格 参数 ， 就 可 以 得 到 如 下 关系 
2fo, wo 
dy »  KpkypKy EN 

对 于 给 定 的 传感器 常数 im 和 e, REEL UR E 
满足 式 (6.16) 和 式 (6.17) f Ky M K,。 男 一 方 
面 ， 闭 环 扰动 /输出 的 函数 为 

sR, 
O(s) kkKpKipKy (1 +sT,) 
D(s) "d sb | s 
l 大 pr l hk, KpkppKy 

该 函数 表明 扰动 抑制 因子 为 X (8) = Kphyp Ky, 
并 且 是 固定 的 。 关 于 扰动 动力 学 ， 应 该 牢记 由 PI 
生 的 原点 处 的 零 值 、 在 * = -1/7, 处 的 真正 极点 ， 以 
及 实 部 为 -lon 的 成 对 共 轿 复 极点 。 在 这 种 情况 下 ， 
使 控制 系统 从 关节 位 置 的 扰动 作用 中 恢复 所 需 的 输出 
恢复 时 间 的 估计 值 T 就 可 以 通过 分 析 上 述 传递 函数 
的 模型 得 出 。 这 一 估计 值 可 以 相应 地 表示 为 T, = 
max|T,, 1/tw|, 


基于 多 关节 模型 的 控制 器 设计 
近年 来 ， 人 们 已 经 提出 了 许多 基于 机 械 臂 整体 


Ky ky = (6. 17) 


(6. 18) 


6. 3.2 


运动 学 模型 的 独立 关节 控制 方案 (多 关节 模型 ) 。 
例如 ， 计 算 转 和 矩 类 控制 方法 ， 参 考 文 献 [6.12] 中 
处 理 水 平 运动 的 调节 任务 , 参考 文献 [6.13] 和 
[6.14] 中 处 理 任意 平滑 轨迹 的 跟踪 任务 。 因 为 考 
察 的 是 整体 运动 学 模型 ， 所 以 需要 处 理 关 节 之 间 
的 耦合 作用 。 这 样 的 控制 方案 将 在 6.6 节 中 详细 


介绍 。 
6.3.3 小 结 和 扩展 阅读 


在 本 节 中 ， 我 们 已 经 提出 了 两 个 独立 的 关节 控 
制 方案 : 一 个 基于 单 关 节 模 型 ， 另 一 个 基于 多 关节 
模型 。 前 者 侧重 于 单一 关节 的 动力 学 以 及 关节 之 间 
相互 作用 产生 的 扰动 。 这 种 控制 方案 简单 ,但 可 能 
不 适合 高 速 跟踪 。 因 此 ， 我 们 介绍 了 后 者 ， 考 虑 了 
机 器 人 机 械 臂 的 整体 动力 学 模型 来 处 理 关 节 中 间 的 
相互 作用 。 

基于 单 关 节 模 型 的 独立 关节 控制 中 应 用 了 许多 不 
同 的 反馈 类 型 (如 纯 位 置 反 馈 或 位 置 、 速 度 和 加 速 
度 反馈 ) 。 参 考 文献 [6.4] 给 出 了 完整 的 讨论 。 当 
我 们 需要 关节 控制 伺服 来 以 高 速 和 加 速度 跟踪 参考 轨 
迹 时 ， 上 述 方案 的 跟踪 性 能 不 可 避免 地 会 递减 。 一 种 
可 能 的 补救 办 法 是 采用 分 散 前 馈 补 偿 来 降低 跟踪 


误差 


6.4 PID 控制 


传统 上 ， 机 器 人 机 械 辟 的 控制 方案 可 以 被 理解 为 
每 个 电动 机 驱动 机 械 辟 关节 级 的 PD 或 PID 补偿 器 参 
Bee 这 样 一 个 简单 的 事实 : 基本 上 ， 当 PD 控 
制 器 应 用 于 双 积 分 器 系统 时 ， 它 是 一 个 具有 和 良好 闭 
环 性 能 的 位 置 与 速度 反馈 控制 器 。 自 齐 格 勒 - 尼 柯 尔 
斯 的 PID 整定 规则 于 1942 4E rh Ji (52, PID 控制 
就 有 了 悠久 的 历史 。 实 际 上 ，PID 的 控制 优势 在 于 
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其 简单 性 和 有 明确 的 物理 意义 。 至 少 在 工业 上 ， 如 
果 通 过 复杂 控制 获得 性 能 提高 是 十 分 不 够 的 ， 那 么 
简单 的 控制 则 优 于 复杂 的 控制 。PID 控制 的 物理 意 
X WR. P- 控 制 是 指 由 当前 状态 到 期 望 状态 的 
当前 的 作用 ; 工控 制 是 指 以 往 状态 经 验 信 息 的 累积 
WEH; D- 控 制 是 指 反映 未 来 状态 的 趋势 信息 的 预期 
作用 。 


6.4.1 调节 的 PD 控制 


机 械 辟 控制 的 一 个 简单 设计 方法 是 相对 于 一 个 
操作 点 的 、 利 用 基于 系统 线性 化 的 线性 控制 方案 。 
此 方法 的 一 个 例子 是 一 种 具有 重力 补偿 方案 的 PD 
控制 “i。 重 力 补偿 是 一 种 偏差 纠正 ， 仅 对 引起 
超 调和 非 对 称 瞬 态 行为 的 力 进 行 补 偿 。 它 具有 以 下 


T-K,(q,-4) -K,q +T:(q) (6.19) 
XP, K, MK, e REEE 28 FE, IURI SR 
对 于 设 定 点 调节 是 非常 有 用 的 ， 例 如 ，q。 是 常 
BOTS) 。 采 用 此 控制 器 时 ( 见 式 (6.1) ) ， 闭 环 方 
程 则 变 成 
H(q)q +C(4,4)q *K,q -K,e,-0 (6.20) 
A, e =q -4, FA y=[e,, 4 ] -0. X 
在 ， 由 带 重 力 补偿 的 PD 控制 得 到 的 稳定 性 可 根据 闭 
环 动力 学 进行 分 析 (6. 20) 。 考 虑 正定 函数 


和 es E" 
Ve, q'H(q)4 + Kye, 


然后 ， 通 过 使 用 6.1 节 中 的 性 质 6.2， 对 q 的 任意 
值 ， 函 数 导数 变 成 半 负 定 的 。 即 
V2-d'Kuiàs-AQ(K)lglh (621) 
zB, Ann (Ky) 是 Ky 的 最 小 特征 值 。 通 过 引用 李 雅 
普 诺 夫 (Lyapunov) 稳定 性 理论 和 拉萨 尔 (LaSalle) 
定理 ,可 以 看 到 ， 调 节 误 差 将 逐渐 收敛 为 零 ， 
而 其 高 阶 导数 保持 有 界 。 尽 管 比较 简单 ， 但 是 这 
种 控制 器 需要 重力 分 量 (结构 和 参数 ) 方面 的 
知识 。 
现在 ， 考 虑 简单 的 无 重力 补偿 的 PD 控制 
T-K,(qu-4) -Kg 
则 闭环 动力 学 方程 变 成 
H(q)q *C(q,q)q *«(q) +Kyq - Kye, -0 
(6.23) 


(6.22) 


考虑 正定 函数 


Tx " | ox 
V--4'H(q)d *-ye,Kye, + U(q) +U, 


shh, U(q) Æ 8U(q)/8q 2 T«(q) WHEE; U,J&— 
个 合适 的 常数 。F 的 时 间 导 数 和 闭环 动力 学 方程 
(6.23) 给 出 了 与 之 前 利用 重力 补偿 相同 的 结果 式 
(6.21)。 在 这 种 情况 下 ,控制 系统 必须 在 李 雅 普 诺 
夫 意 义 上 是 稳定 的 ,但 它 不 能 得 出 根据 拉萨 尔 定 
BHO ,调节 误差 将 收敛 到 零 的 结论 。 实 际 上 ， 该 系 
统 精 度 (调节 误差 向 量 的 大 小 ) 将 取决 于 下 面 公式 
中 增益 矩阵 K; 的 大 小 。 

lle, IS Kp" [Lo (6. 24) 
st, g 766.1 节 的 性 质 6.4 中 。 因 此 ， 调 节 误 差 可 
以 通过 增加 K, 而 任意 减少 ; 然而 ， 测 量 噪声 和 其 他 
未 建 模 的 动力 学 因素 ， 例 如 驱动 器 摩擦 ， 将 限制 高 增 
益 在 实际 中 的 使 用 。 


6.4.2 调节 的 PID 控制 


为 了 处 理 重力 问题 ,我 们 将 在 之 前 的 PD 控制 中 
增加 一 种 积分 作用 ， 在 某 种 程度 上 ， 这 可 以 看 作 是 常 
值 扰 动 (从 局 部 观点 看 ) 。PID 调节 控制 器 可 以 写成 
以 下 一 般 形 式 

T-K(q,-q) * Kj (a, -qd -Rd 
式 中 , Ke 天 “是 一 个 正定 增益 矩阵， 并 且 ， 若 
Ka-0) = 四 -9 我 们 有 PID 控制; 车 k [C di 
增加 ， 我 们 有 PPD 控制; ASC +) =tanh(，) ， 我 们 
有 PD + 非 线 性 积分 控制 。 

对 于 含有 外 绕 的 机 器 人 运动 控制 系统 ， 如 库仑 摩 
擦 ，PID 控制 的 全 局 浙 近 稳定 性 (GAS) 已 在 参考 文 
HK [6.12] 中 证 明 。 (Tomei) 在 参考 文献 [6.19] 
中 也 通过 对 重力 项 的 自 适应 证 明了 PD 控制 的 全 局 渐 
近 稳 定性 。 男 一 方面 ， (Ortega). 等 人 在 参考 文献 
[6.20] 中 表明 ，PFD 控制 在 存在 重力 和 有 限 外 绕 时 
可 能 会 产生 半 全 局 渐 近 稳定 性 (SGAS), 

另外 ， 在 参考 文献 [6.21] F, (Angeli) 证 明 
PD 控制 对 于 机 器 人 系统 可 以 实现 输入 -输出 对 状态 稳 
4E (10SS)。 此 外 ，( Ramirez) 等 人 在 参考 文献 
[6.22] 中 证 明了 PID 增益 〈 某 些 条 件 下 ) 的 半 全 局 
渐 近 稳定 性 。 此 外 ，(Kelly) 在 参考 文献 [6.23] 中 
证 明了 PD 加 非 线 性 积分 控制 可 以 实现 在 重力 下 
的 GAS。 
事实 上 ，PID 控制 中 的 一 个 大 的 积分 作用 会 造成 
运动 控制 系统 的 不 稳定 。 为 了 避免 这 种 情况 ， 积 分 增 
FTE Pot ERA 
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式 中 心 是 6.1 节 的 性 质 6. 1 PAY; Kp =k, K =k 
All Ky =k,I。 这 一 关系 为 增益 的 选择 提供 了 隐 仿 的 指 
导 。 此 外 ，PID 控制 产生 了 大 量 的 PID 控制 附属 物 。 
例如 ，PID 附加 摩擦 补偿 器 ，PID 附加 重力 补偿 器 ， 
PID 附加 扰动 观测 器 。 


6.4.3 PID 增益 整定 


PID 控制 可 用 于 轨迹 跟踪 和 设 定点 调节 。 真 正 的 
跟踪 控制 在 6.5 节 后 介绍 。 在 本 节 中 ， 将 介绍 实际 使 
用 中 简单 是 有 用 的 PID 增益 整定 方法 。 一 般 PID 控制 
器 可 以 被 写成 下 面 一 般 的 形式 : 

T = Kye, + Kye, +K, fedt 
或 男 一 种 形式 : 


T= (x + i) (e, + Kye, + K, je di) (6.25) 


在 一 个 跟踪 控制 系统 的 基本 稳定 性 分 析 中 ， 
Qu 等 人 在 参考 文献 [6.24] 中 证 明 PD 控制 可 以 满 
足 一 致 最 终 有 界 性 (UUB)。 此 外 ,在 参考 文献 
[6.25] 中 ，Berghuis 等 人 提出 输出 反馈 PD 控制 ， 该 
控制 方法 在 重力 和 有 界 扰动 下 满足 半 全 局 一 致 最 终 有 
界 性 (SGUUB)。 最 近 ，choi 等 人 提出 了 逆 优 化 PID 
控制 方法 ， 它 确保 了 扩展 扰动 的 输入 -状态 稳定 
TE (ISS), 

实际 上 ， 如 果 PID 控制 器 式 (6.25) 被 反复 应 
用 到 同一 设 定点 或 期 望 轨迹 ， 那 么 ， 最 大 误差 将 与 下 
式 中 的 增益 成 比例 关系 : 


2 
max |e, (1) ——— (6. 26) 
O<tSt¢ 2» +1 


AP, 4 指 给 定 任 务 的 最 终 执行 时 间 ， 并 


K = kl, 


这 种 关系 可 以 用 来 调整 一 个 PID 控制 器 的 增益 ， 被 称 
为 复合 整定 规则 5 。 复 合 整定 规则 暗含 如 下 简单 的 
调整 规则 ; 


平方 整定 : 对 于 一 个 小 的 k，maxlle, ley, 
线性 整定 : 对 于 一 个 大 的 k，maxlle, leyo 

例如 ,假设 我 们 选取 正 的 常数 对 角 和 矩阵 K, = 
kJ, K -kI, Bi ko >2k XT E, E 
平方 整定 规则 ， 如 果 我 们 减少 y 为 /2， 最 大 误差 将 
减少 1/4。 对 于 大 的 上 值 ， 根 据 线性 整定 规则 ， 最 大 
误差 将 会 成 比例 地 随 着 y 而 减少 。 这 意味 着 当 其 他 增 
益 参 数 被 确定 后 ， 我 们 可 以 仅仅 使 用 一 个 变量 y 来 调 
整 PID 控制 器 ““ 。 尽 管 这 些 规 则 对 调整 控制 性 能 是 
非常 有 用 的 ， 但 是 它们 仅 能 够 使 用 于 相同 点 设 定 或 期 
望 轨迹 的 重复 实验 中 ， 因 为 调节 规则 由 比例 关系 


构成 。 


6.4.4 扩展 阅读 


PID 类 型 的 控制 器 是 为 了 解决 调节 控制 问题 而 设 


计 出 来 的 。 这 些 控制 
或 模型 参数 。 此 外 ， 
实现 的 稳定 性 。 读 者 


x 2r [6.1,15,16,22,27,28 
论文 e 


6.5 跟踪 控制 


方法 的 优点 是 无 须知 道 模 型 结构 
本 节 介 绍 了 PID 类 型 的 控制 器 所 
可 以 找到 很 多 详细 介绍 PID 控制 


中 的 各 种 调节 方法 及 其 具体 证 明 的 书籍 和 


独立 的 PID 控制 对 多 数 设 定点 调节 问题 来 说 是 
足够 了 ,但 是 还 有 许多 任务 需要 有 效 的 轨迹 跟踪 能 
力 ， 比 如 ， 等 离子 焊接 、 激 光 切 割 或 者 存在 障碍 物 
情况 下 的 高 速 操作 等 。 这 些 情 况 中 ， 运 用 局 部 方案 
需要 在 大 量 中 间 设 定点 中 慢 速 移动 ， 所 以 大 大 延迟 
了 任务 的 完成 。 因 此 为 了 改善 轨迹 跟踪 的 效果 性 能 ， 


AN 


模型 。 
在 关节 或 任务 空 


A x. 以 及 4. 


别 描述 的 是 期 望 的 速度 和 加 速度 。 为 了 得 到 好 的 


控制 句 应 该 考虑 计算 转移 类 技术 的 机 械 臂 的 动态 


间 中 的 跟踪 控制 问题 包括 给 定 的 


时 变 轨 迹 gu(:) 或 者 x,(1)、 它 们 的 连续 微分 galt) 


1(1) 或 x ,(1)， 这 些 参数 分 


方法 。 
6.5.1 


的 直觉 。 在 关节 空 
AX: 

T-H(q)v 
将 式 代 入 到 式 (6.1 


系统 方程 组 ， 例 如 


性 能 ， 必 须 尽力 发 展 基于 模型 的 控制 策略 “271。 
在 文献 所 报道 的 控制 方法 中 ， 典 型 方法 包括 道 动 
力学 控制 、 反 馈线 性 化 技术 和 基于 被 动 性 的 控制 


逆 动 力学 控制 

尽管 逆 动 力学 控制 有 理论 上 的 背景 ， 
讨论 的 反馈 线性 化 技术 ,但 是 它 的 起 点 是 基于 消 
除非 线性 项 和 解 厅 每 个 连 杆 动力 学 的 机 械 工程 上 


如 后 面 


间 中 的 逆 动 力学 控制 有 如 下 


*C(q,q)q *T:(q) (6.27) 
) 中 ,会 得 出 n AHER B Be HE 


q =v, HP» &—^ 8i 


的 辅助 控制 输入 变量 。v 的 典型 选择 是 


q) * K,(q, 


v-4,*K,(q, 


或 带 有 积分 分 量 


q) (6.28) 


v= fa + Ky (qi d) + KK, 4) * Ki] (qu - di 


(6. 29) 
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推导 得 到 对 于 辅助 控制 的 输入 式 (6.28). 的 误差 动 
力学 方程 


€, * Ky e, * K,e, =0 
如 果 使 用 了 辅助 控制 输入 式 (6. 29) ， 误 差 动 力学 方 
程 则 为 


e? +K, €, +K,e, +Ke, =0 
通过 选择 合适 的 增益 矩阵 K,、K，( 和 Ki) ， 两 者 的 误 
差 动 力学 方程 都 是 呈 指 数 级 稳定 的 。 

或 者 ， 首 动力 学 控制 可 以 在 操作 空间 中 描述 。 考 
虑 操作 空间 动力 学 式 (6.9) ， 如 果 在 操作 空间 中 采 
用 下 面 的 逆 动 力学 控 种 
f, -A(QD CX, +K, +Kpe,) +T(g,g)x «m(q) 
WP e, =xu -xY， 则 产生 的 误差 动力 学 方程 为 

€, t Kye, c Ke, =0 (6.30) 

它 也 是 呈 指 数 稳定 的 。 采 用 这 种 控制 器 的 一 个 明显 优 
点 是 可 以 选择 在 操作 空间 中 有 清晰 物理 意义 的 K, 和 
K,。 但 是 ， 如 式 (6.10) 所 见 ， 机 器 人 接近 奇异 位 
形 时 ,4(4) 值 会 变 得 很 大 。 这 意味 着 为 了 移动 机 械 
辟 ， 在 某 个 方向 上 需要 很 大 的 力 。 


6.5.2 反馈 线性 化 


这 种 方法 是 刚性 机 械 臂 首 动 力学 概念 的 广义 化 。 
反馈 线性 化 的 基本 思想 是 构造 一 个 所 谓 的 内 环 控 制 
的 变换 ， 它 使 非 线 性 系统 在 坐标 进行 了 合适 的 状态 
空间 变化 后 能 精确 地 线性 人 化。 这样， 设计 者 就 能 在 
新 的 坐标 系 中 设计 出 第 二 级 或 外 环 控制 以 满足 传统 
控制 方案 要 求 ， 如 轨迹 跟踪 、 抗 扰动 等 "2 。 如 果 
设计 者 在 机 械 臂 的 动力 学 描述 中 包括 了 传动 动力 学 ， 
例如 轴 弯 曲 引起 的 弹力 ,齿轮 弹力 等 ,那么 ， 机 械 
臂 控 制 的 反馈 线性 化 方案 的 整个 力量 就 变 得 显 而 易 
见 了 。 

近 几 年 来 出 现 了 大 量 令 人 印象 深刻 的 关于 非 线性 
系统 微分 几何 方法 的 文献 。 此 领域 的 大 多 数 结果 目的 
是 给 出 非 线性 系统 各 种 几何 性 质 的 与 坐标 无 关 的 抽象 
描述 ， 但 这 对 非 数 学 家 来 说 很 难 理解 。 本 节 的 目的 是 
给 出 反馈 线性 化 方案 的 基本 思想 ， 并 介绍 这 项 技术 的 
一 个 简单 版 本 ， 以 找到 机 械 辟 控制 问题 的 直接 应 用 。 
读者 可 参考 文献 [6.30], ， 了 人 解 采用 微分 几何 方法 的 
反馈 线性 化 技术 的 综合 法 。 

现在 考虑 一 般 的 输出 &e R*?， 找 到 一 个 简单 方法 
来 确定 机 械 臂 动力 学 方程 (6.1) 的 线性 化 状态 空间 
表述 : 


= 


£-h(q) +r(1) (6.31) 
str, alq) 是 关节 坐标 9< 尼 的 一 个 一 般 的 预定 函 


数 ， 而 且 r(i) 是 一 般 的 预定 时 间 函 数 。 控 制 目标 将 
是 选择 关节 转 矩 输入 z 值 使 输出 专 (上 ) 变 为 零 。 

h(q) 和 r(t) 的 选择 是 基于 控制 目标 的 。 例 如 ， 
如 果 我 们 硕 望 机 械 臂 跟踪 的 期 望 关节 空间 的 轨迹 满足 
h(q) = -q, Era) =q), JA EG) =q) - 
q(t) =e,(¢) 则 为 关节 空间 的 跟踪 误差 。 在 这 种 情 
WP, SEU) 为 零 ， 会 使 关节 变量 g(1) 跟踪 其 期 
望 值 gy(t)， 从 而 产生 机 械 辟 轨迹 跟踪 问题 。 男 外 
一 个 例子 , E) 表示 操作 空间 跟踪 误差 , E(t) = 
x.) -x(t) 三 e,(1)。 那 么 控制 &(t) 变 为 零 会 在 期 
望 运动 通常 已 经 指定 的 操作 空间 上 直接 产生 轨迹 
IREK o 

为 了 得 到 机 械 臂 控制 器 设计 的 线性 状态 变量 模 
型 ， 就 要 对 输出 &(1) 进行 二 阶 微分 ， 可 得 


£a TH (6.32) 
é =Tg «T4 +r 
其 中 ,我 们 定义 一 个 (p xn) 的 变换 矩阵 为 
ah(q) (9h ðh oh 
Tla) = ðq = (55, ðq, A 66.94] 
给 定 输出 h(g) ， 直 接 计算 与 h(g) 相关 的 变换 矩阵 
T(g)。 在 表示 为 操作 空间 速度 误差 的 特殊 情况 下 ， 
T(q) 表示 的 是 雅 可 比 矩 阵 J(gq)。 
根据 式 (6.1), A 


(6.33) 


q =H '(q)[t-n(q.4)] (6.35) 
有 非 线性 项 的 表达 式 为 


那么 ， 由 式 (633) 推导 出 


=F «T4 «T()H^ (q)|t-n(q, 4)] 


(6.37) 
定义 控制 输入 函数 为 
u- T «Tq «T(g)H^ (q)[tT-n(q, 4)] 
(6.38) 


现在 可 以 定义 状态 y(1) e R”, Hy-(£ &), ， 机 械 
臂 动力 学 方程 写 为 


. (9 I, 0 
ene e» 
这 是 线性 状态 空间 系统 的 表达 式 
y - Ay + Bu (6. 40) 


由 控制 输入 驱动。 由 于 A 和 B 的 特殊 形式 ， 这 个 系 
统 被 看 做 是 布鲁诺 夫 斯 基 上 典型 构成 ,而且 总 是 可 控制 
的 ， 输入 为 u(t)。 

由 于 式 (6.38) 被 认为 是 对 机 械 辟 动力 学 方程 
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的 线性 化 变换 ， 进 而 通过 反 变 换 可 以 得 出 关节 转 和 矩 的 
表达 式 为 
T-H(q)T' (q)(u- F - Td) *n(q,4) 
(6.41) 
式 中 , T ERMEE T) WEK- AA 
和 矩阵。 

在 特殊 情况 下 专 =e,(1) ， 并 且 如 果 根 据 PD 反馈 
Wu=-KpE-K,é, VER u(t) 使 式 (6.39) 稳 
定 , 那么 T= -7,。 由 式 (6.41) 定义 的 控制 输入 转 
FETE) 会 使 机 械 辟 按照 使 y(t) 变 为 零 的 方式 运动 
在 这 种 情况 下 ， 反 馈线 性 化 控制 和 逆 动 力学 控制 将 
相同 。 

6.5.3 被 动 控制 

这 种 控制 方案 明确 地 使 用 了 拉 格 朗 日 系统 的 被 动 
性 性 质 * 3。 较 之 道 动力 学 方法 ， 被 动 控 制 器 不 依 
赖 于 对 机 械 臂 非 线 性 的 准确 去 除 ， 它 比 前 者 具备 更 好 
的 鲁 棒 特 性 。 下 式 给 出 了 被 动 控制 输入 。 


a>0 


a o 


qd,-q,*06,, 
T-H(q) q,*C(q, q)q, * «(q) +Ky é, * K,e, 
(6.42) 
通过 式 (6.42) ， 可 以 得 到 下 面 的 闭环 系统 
H(q)s,*C(q,q)s, - Ke, ^ K,ee, -0 (6.43) 
HP, s,=é, + ae 选取 李 雅 普 诺 夫 函 数 V(y, t) 
如 下 : 


1 (aK, +K,+aH aH 
feng M 
aH H (6.44) 
-ly» 
由 于 上 述 方程 是 正定 的 ， 所 以 它 在 原点 处 平衡 ， 即 
y-(e!, à1)' -0, IAN, 了 由 下 式 限定 


c, [yl Sy Py Soy lly |P ,ov=0, >0 (6.45) 
将 了 对 时 间 求 导 得 到 
V--éK,é,-ae,K,e,- -y' Qy«0 (6.46) 


Est" Q-dig[oaK,, Ky], HF Q 是 正定 的 ， 并 
HJ& y 的 二 次 函数 ， 所 以 也 可 以 得 到 下 面 的 限定 关 
系 式 


ka lly? Sy" Qy Sry lly f, Ky 2, >0 (6.47) 
SR Jai EH EPS AAR PA V. WREX] 
J 2 K m 
V<-x«,|lylP = -2nV,n=— (648) 
Oy 
最 终 可 以 得 到 
V(t) €V(0) e ?" (6.49) 


这 已 经 表明 a 的 大 小 会 大 大 影响 跟踪 结果 “> 。 在 wa 

取 小 的 数值 情况 下 ， 机 械 辟 更 加 容易 发 生 振动 。 大 的 

a 值 对 应 着 更 好 的 跟踪 性 能 ， 并 且 在 位 置 误差 较 小 

时 ， 可 让 *, 避 免 受 到 速度 测量 噪声 的 影响 。 参 考 文献 

[6.34] 表明 式 (6.50) 被 用 于 二 次 优化 。 
K, = aK, 


(6. 50) 


6.5.4 小 结 


本 闻 回 顾 了 到 目前 为 止 提出 的 一 些 基 于 模型 的 运 
动 控 制 方法 。 在 这 些 控制 方法 中 ， 理 论 上 讲 ， 闭 环 系 
统 能 够 提供 系统 的 渐 近 稳定 或 者 全 局 指数 稳定 。 然 而 
这 些 理想 的 状态 在 实际 情况 下 并 不 能 达到 ， 这 主要 由 
于 实际 的 系统 受到 采样 率 、 测 量 噪 声 、 扰 动 和 未 建 模 
的 动态 参数 的 影响 “3 


6.6 计算 转 矩 控制 


多 年 来 ， 各 式 各 样 的 机 器 人 控制 方案 被 提出 来 。 
它们 中 的 多 数 可 以 被 视 为 将 线性 化 的 反馈 控制 方案 应 
用 于 非 线性 系统 的 计算 转 矩 控制 类 方案 的 特例 (Cl 
图 6.5 所 示 ) 了 了 5。 这 一 节 中 首先 介绍 计算 矩阵 控 
制 的 概念 ， 之 后 将 介绍 一 种 它 的 变形 形式 ， 所 谓 的 计 
算 转 矩 类 控制 。 


C(q.d)d + Te) 


图 6.5 计算 转 矩 控制 


6.6.1 计算 转 矩 控制 
回顾 式 (6.27) 中 的 控制 系统 输入 变量 
T-H(q)v +C(q,q)q +%(q) 
上 式 也 被 称 为 计算 转 矩 控制 。 它 由 一 个 内 在 的 非 线性 
补偿 回路 和 一 个 有 外 生 控 制 信号 v 的 外 部 回路 组 成 。 
将 这 种 控制 方案 应 用 于 机 器 人 机 械 辟 的 动力 学 模型 ， 
得 到 


q =v (6.51) 
需要 注意 的 是 ， 这 种 控制 输入 将 一 个 复杂 的 非 线 性 控 
制 器 设计 问题 转化 成 了 一 个 由 工 个 子 系统 组 成 的 线性 
系统 设计 问题 。 一 种 外 部 回路 控制 " 是 式 (6.28) 中 
所 示 的 PD 反馈 : 
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v-q,-K,6, * K,e, 
这 种 情况 下 ， 总 的 控制 输入 表达 式 为 
T-H(q)(q,*Ky6, * K,e,) +C(q, q)q *T:(q) 
并 且 由 此 产生 的 线性 误差 动力 学 方程 为 
e, *Kye, * K,e, =0 
根据 线性 系统 理论 ， 确 定 跟踪 误差 收敛 到 零 。 
备注 : 
一 般 情 况 下 ， 为 了 确保 误差 系统 的 稳定 性 ， 令 
K, Kp Aon x n W Xt fA TE xe KEM, BI K, = diag 
(Kyi, 7, Kyn) >0, Kp =diag(Kp,, «+, Kpn) 20, 
SRT, Pb ACE GR H(q) 和 内 环 完全 非 线 性 
补偿 项 CCG, 9) qd *T«Ca) 扰乱 不 同 控制 通路 的 
关节 信和 号， 上述 控 制 形式 并 不 能 得 到 关节 的 独立 
控制 。 


6.6.2 ”计算 转 矩 类 控制 


值得 注意 的 是 ， 奉 想 应 用 计算 转 和 矩 控 制 ， 就 
需要 确保 动力 学 模型 的 各 个 参数 完全 已 知 ， 并且 
控制 输入 信号 能 够 实现 实时 计算 。 为 了 避免 这 样 
的 问题 ， 提 出 了 一 些 变化 ， 例 如 计算 转 矩 类 控制 。 
计算 转 矩 类 控制 器 可 以 通过 修正 如 下 计算 转 矩 控 
制 得 到 : 


(6.52) 


T-H(q) +C(g, d) q +T(g) (6.53) 
Rp, ^ 代 表 计 算 值 ， 并 且说 明了 理论 上 的 精确 反馈 
线性 控制 不 能 在 实际 的 不 确定 性 系统 中 实现 。 图 6.6 
为 该 类 控制 方案 的 示意 图 。 


C (q.d)d * iD 


图 6.6 计算 转 矩 类 控制 


1. 具有 变 结构 补偿 的 计算 转 矩 类 控制 

由 于 系统 参数 的 不 确定 性 ， 为 实现 轨迹 跟踪 就 需 
要 在 外 回路 设计 中 设计 补偿 项 。 下 式 为 具有 变 结构 补 
偿 的 计算 转 矩 类 控制 方案 的 表达 式 。 


v = q,*K, e, * Koo, +Av (6. 54) 
式 中 ， 变 结构 补偿 项 可 以 表达 为 
-p(x, 1) BP. itiB"Px | <0 
Av = | B^ Px | (6.55) 


0, if||B" Px || -0 


式 中 , ete e1)", B=(0, L)", P &— ^ 
(2nx2n) 的 满足 式 (6.56) 的 对 称 正定 矩阵 。 


P4+4P= -Q (6.56) 
AP, ABE A 被 定义 为 
0 I, 
a( “ ^] (6.57) 


Q 是 任意 一 个 合适 的 对 称 正 定 和 矩阵 (2n x2n), 
p(x, t) 2 [of + [KI] e Hé, D] 


l-a 


(6. 58) 


sth, a MEREEX |H (a) BH) -1 llo < 
1 对 所 有 的 ge RABE, H SUD, [o,e ) ll g(t) || <£; 
开 是 一 个 (nx2n) WEE, JFH K-[K, Ky]; 对 
qeR', dH (有 An， 其 中 ，An 是 一 个 正常 数 ; 
此 外 函数 4 定义 为 式 (6. 59 ) : 
Ca. 4) -Cg, 4014 +[t(g) -Tla llo, 1) 
(6.59) 
MWAH, MAHER AK ew est (6.60) 可 以 使 
sk (6.59) 的 跟踪 误差 收敛 到 零 。 
Vzx'Px (6. 60) 
这 由 参考 文献 [6.5, 40] 中 的 稳定 性 分 析 得 出 。 


1) 由 6.1 节 中 的 性 质 6.1， 存 在 正 的 常数 入 与 
ds H ALS |H) SAn, 使 此 不 等 式 对 9 e RK 


H=—I, (6.61) 
Cc 
het, 
AP, c= ty WRA 
a An -Àn 
|H^(q)H(q) -I,|&——— —oa«1 (6.62) 
gu t^, 


sk (6.62) 说 明 ， 对 于 相同 的 w <1， 总 是 存在 


至 少 一 个 万 满足 关系 式 。 
2) 由 于 Av 存在 的 间断 点 ， 当 运用 控制 方案 时 
可 能 会 发 生 拌 振 现象 。 值 得 注意 的 是 ， 由 于 控制 中 高 
频 分 量 能 够 激发 未 建 模 的 动力 学 作用 (例如 关节 柔 
性 ) ， 拌 振 现 象 经 常 是 不 可 预期 的 ”331。 为 了 避免 
持 振 现象 ， 采 用 变 结构 补偿 的 方法 如 : 
pls, DT 当 | Pele 
Av = (6.63) 
zel, D Ope, IB'Pr|<e 


AF, 是 一 个 用 来 作为 边界 层 的 正常 数 。 根 据 这 一 
修正 ， 跟 踪 误 差 的 收敛 性 可 以 被 限定 在 一 定 的 残 差 集 
范围 内 ， 当 e 很 小 的 时 候 便 可 以 得 到 一 个 很 小 的 残 差 
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2. 具有 独立 关节 补偿 的 计算 转 矩 类 控制 

前 一 种 补偿 方案 是 集中 的 ， 这 就 意味 着 若 想 实 
现在 线 计算 需要 完成 大 量 的 计算 任务 ， 并 且 需 要 昂 
贵 的 硬件 作为 支持 。 为 了 解决 这 一 问题 ， 下 面 将 介 
绍 一 种 带 独立 关节 补偿 的 计算 转 矩 类 控制 方案 。 在 
这 种 计算 转 矩 类 控制 方案 中 ， 通 过 估计 得 到 下 述 关 
RA: 


H(q) =1, C(q, d) -0, $4) =0 (6.64) 
使 用 外 环 中 的 变量 w ， 得 到 
V =Kye,+K,e,+Av (6. 65) 
式 中 ， 正 常数 选取 K, 和 K,， 且 足够 大 ; Av =(0,, c, 
v.) 中 的 第 i 个 分 量 Av ,定义 为 


£i 


如 果 | 5; 


|s- 


E M 
B eXq,, qa) ei 


Av,= 


如 果 |s, | > 


" ` , 则 -8 e(q,.d4)1 4 
B'oXq,, qa) | | 


5; 
5; 


(6. 66) 


在 这 种 补偿 中 ， 
且 A; 为 正常 数 。 
得 到 ; 
|H(g) g s+C(q, q)q,| *T«(q) |SB, + 
Bllall+ lia l2 B^ (a. 4) 
并 且 ， B= (B, b2, BE 进而 有 


e,:tAie,i, iell, s, n], 并 


进一步 根据 机 械 辟 的 性 质 ， 可 以 


5j 


e(q, 9)=[1, llall, la I" (6. 67) 
最 后 ，s, 是 边界 层 的 可 变 长 度 , ie fl, =, nt, 3f 
且 满 足 

£,2 -ge,, (0) >0, g,>0 (6. 68) 


这 里 值得 指出 的 一 点 是 控制 方案 中 的 变量 w 被 设计 
为 期 望 补偿 而 不 是 反馈 。 进 一 步 来 讲 ， 这 种 控制 方 
案 是 之 前 那 种 关节 独立 控制 的 一 种 形式 ， 并 且 具 备 
前 面 提 到 的 那些 优点 。 通 过 应 用 李 雅 普 诺 夫 函 数 可 
以 在 式 (6.69) 中 体现 跟踪 误差 逐渐 趋 于 零 这 一 
特点 : 


1, pep (AKp HNE a 
veles í E P gi 6; 
H AH/Xe, i=l 


(6.69) 
它 沿 着 闭环 系统 轨迹 的 时 间 导 数 为 
V = -a a (6.70) 


WAR Ky A y 足够 大 ， 则 可 以 得 到 a 为 某 一 正常 数 。 
关于 稳定 性 的 详细 分 析 在 请 参考 文献 [6.13] 


与 具有 变 结构 补偿 的 计算 转 矩 类 控制 类 似 ， 考 虑 
如 下 的 非 零 边界 层 : 
£,2-g6,, £(0) >0, g,,a;>0 (6.71) 

根据 这 样 的 修正 ， 跟 踪 误 差 的 收敛 性 可 以 被 
限定 在 一 定 的 残 差 集 范围 内 ， 当 & 很 小 的 时 候 便 
可 以 得 到 一 个 很 小 的 残 差 集 范围 。 为 了 完成 点 到 
点 的 控制 任务 , 设计 了 一 个 带 有 重力 补偿 的 PD fs 
ill a o 

H(q) =1, C(q, 4) =0, &(q) =T8(q) 
UP, te (q) 是 机 械 臂 动 力学 模型 的 重力 项 。 

使 用 外 环 中 的 变量 w， 得到: 


(6.72) 


y 2 K,é, + Ke, (6.73) 
在 这 样 的 情况 下 ， 控 制 输入 变 为 
T-K,e, - K,e, * T.(q) (6. 74) 


这 种 控制 方案 较 之 精确 地 计算 转 矩 控制 易于 实现 。 通 
过 应 用 李 雅 普 诺 夫 函 数 可 以 体现 跟踪 误差 逐渐 趋 于 零 


这 一 特点 : 
y- + TH(q) è, + que, (6.75) 
它 沿 着 闭环 系统 解 轨迹 的 时 间 导 数 为 
V= -eK ee, (6.76) 


关于 稳定 性 的 细节 分 析 在 参考 文献 【6. 12] 中 
叙述 。 需 要 注意 的 一 点 是 ， 由 于 前 一 种 控制 方案 基于 
拉萨 尔 不 变 集 引 理 而 要 求 系统 是 自主 的 〈 不 随时 间 
变化 ) ， 这 一 结果 适用 于 调节 情况 而 不 是 轨迹 跟踪 
情况 。 

注 : 

如 果 忽 略 机 械 臂 动力 学 模型 中 的 重力 因素 ， 即 

Telg) =0， 那 么 控制 法 则 变 为 
T=v =Kye,+K,e, (6.77) 

上 式 可 以 引出 纯 PD 控制 。 增 益 和 矩阵 Ks, 和 Ky 可 
以 选取 对 角 线 型 ， 从 而 使 PD 控制 成 为 基于 多 关节 动 
力学 模型 的 独立 关节 控制 的 形式 。 


小 结 和 扩展 阅读 


本 节 提 出 了 两 种 控制 方案 : 计算 和 矩阵 控制 和 
计算 矩阵 类 控制 。 前 一 种 将 多 输入 多 输出 ( MI- 
MO) 的 非 线性 机 器 人 系统 转化 成 了 一 个 非常 简单 
的 解 看 的 线性 闭环 系统 。 因 为 前 一 种 控制 方案 的 
实际 运用 需要 事先 知道 所 有 的 机 械 辟 控制 参数 和 
它 的 有 效 载荷 ， 使 它 显 得 不 太 可 行 。 而 后 一 种 方 
案 放 宽 了 上 述 的 约束 ， 且 仍旧 可 以 实现 目标 系统 


6.6.3 
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的 不 确定 性 跟踪 。 

参考 文献 [6.43] 研究 了 几 种 具备 前 馈 补 偿 的 
跟踪 系统 。 参 考 文献 [6.19] 中 介绍 了 一 种 基于 P— 
D 控制 的 自 适应 控制 方案 。 


6.7 Fights tl 


自 适 应 控制 与 普通 控制 的 最 大 差别 是 自 适应 控 
制 有 一 些 与 时 间 相关 的 参数 ， 并 且 它 具有 根据 闭环 
系统 中 某 些 信号 进行 在 线 调整 这 些 参数 的 机 制 。 即 
使 设备 中 参数 不 确定 ， 这 种 控制 方案 仍然 可 以 达到 
控制 目标 。 本 节 中 我 们 介绍 几 种 在 机 器 人 机 械 臂 动 
力学 参数 信息 不 完全 的 情况 下 的 自 适应 控制 方案 。 
这 些 自 适应 控制 方案 的 控制 性 能 基本 上 是 从 性 质 
6.5 得 出 的 ,包括 自 适应 计算 转 矩 控制 、 自 适应 惯 
性 相关 控制 、 被 动 自 适应 控制 ， 以 及 具有 期 望 补偿 
的 自 适应 控制 。 最后， 将 强调 在 参数 收敛 中 很 重要 
的 持续 激励 条 件 。 


自 适应 计算 转 矩 控制 


计算 转 矩 控制 的 设计 很 有 吸引 力 ， 是 因为 它 允 许 
设计 者 把 MIMO 高 度 耦 合 非 线性 系统 转换 成 十 分 简单 
的 解 粗 线性 系统 ， 它 的 控制 方案 已 为 大 家 所 接受 。 但 
是 这 种 反馈 线性 化 方法 依赖 于 完全 的 系统 参数 信息 ， 
并 且 得 不 到 这 些 信息 会 引起 错误 的 参数 估计 ， 导 致 误 
差 系统 的 闭环 模型 中 产生 不 匹配 项 。 该 项 可 以 理解 为 
在 闭环 系统 输入 处 的 非 线性 扰动 作用 。 为 了 解决 参数 
不 确定 的 问题 ， 我 们 考虑 下 式 有 参数 估计 的 逆 动 力学 
方法 : 
T-H(q)(d ,*Kyé, * Kee) +C(q, d)d +T.(g) 
(6. 78) 
sth, A, C, C, AMH, C, Ts 同样 的 函数 式 。 由 
动力 学 模型 的 性 质 6. 5 有 
Alq) d +C(q, d)d *(«(q) -Y(q, d, d )à 
(6. 79) 
XH, Y(q, 4, d) 是 回归 量 ， 是 一 个 已 知 的 
(n xr) 函数 和 矩阵; a 是 简化 所 有 估计 参数 的 (7 x1) 
向 量 。 把 控制 输入 rz 代入 械 辟 动力 学 方程 ， 得 到 闭环 误 
差 模型 
H(q)( €,+Kyé,+Kye,) -Y(q, d, d)à 
(6.80) 
式 中 ，& =h -a。 为 了 得 到 合适 的 自 适应 法 则 ， 先 假 


6.7.1 


i 


设 加 速度 项 « 是 可 测量 的 ， 而 且 估 计 惯 性 矩阵 
H(q) 不 是 奇异 的 。 为 方便 起 见 ， 误 差 方程 重 写 为 


x-Ax«BH^(q)Y(q, d, d)à (6.81) 
— 0, I, 0, 
XUPx-(el, el)", A= , B= 
: -K, -K, I, 
(6. 82) 
自 适 应 法 则 可 以 认为 是 
a--I"Y(q, 9， 了) 万 (0g)BTPr (6.83) 


式 中 , 芽 是 一 个 (r xr) 的 正定 常数 矩阵 ; P 是 
(2nx2n) 的 对 称 正定 常数 矩阵 ， 且 满足 : 
PA +A'P= -Q (6.84) 

stb, o 是 有 相同 维度 的 对 称 正 定常 数 和 矩阵 。 该 自 适 
应 法 则 有 两 个 假定 ; 

1) 关节 加 速度 g 是 可 测量 的 。 

2) 未 知 参数 的 边界 范围 是 有 效 的 。 
第 一 个 假定 是 为 了 确定 回归 量 Y(gq,，Y，# ) 是 
已 知 的 先 验 ， 而 第 二 个 假定 是 通过 将 估计 参数 a 限 甫 
在 真实 参数 值 范围 内 ， 以 保持 估计 量 有 万 (g) 非 奇异 。 

实际 上 ， 李 雅 普 诺 夫 稳 定性 理论 和 李 雅 普 诺 夫 函 
Be ( 见 下 式 ) 能 确定 跟踪 误差 的 收敛 和 保持 所 有 内 
部 信号 有 界 。 


= 


V = -x'Qx (6.85) 

具体 的 稳定 性 分 析 在 参考 文献 【6.2] 中 详 述 。 
YE: 
由 于 实际 和 理论 上 的 原因 ， 上 述 的 第 一 条 假定 是 
很 难 使 用 的 。 在 多 数 情 况 下 不 容易 做 到 加 速度 的 精确 
测量 ; 但 必须 确定 关于 这 个 扰动 的 上 述 自 适应 控制 方 
案 的 鲁 棱 性 。 此 外 ， 从 纯 理 论 的 角度 看 ,测量 g，g， 
q 意味 着 我 们 不 仅 需 要 整个 系统 的 状态 向 量 ， 还 需 
要 它 的 导数 。 
6.7.2 自 适应 惯性 相关 控制 

这 里 介绍 另外 一 种 自 适 应 控制 方案 。 本 节 提 出 的 
方案 不 需要 机 械 臂 加 速度 的 测量 值 ， 也 不 需要 估计 惯 
性 矩阵 的 转 置 ， 因 此 能 避免 自 适应 计算 转 矩 控制 方案 
的 不 足 。 我 们 先 看 控制 输入 


T=H(q)v +C(q, d)v &&(q) * Kys 
式 中 ， 辅 助 信号 " 和 8 定义 为 v= q,+Ae, Als =0 - 
q=e,+Ae,, HARA (n xn) 的 正定 矩阵 。 根 


(6. 86) 
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据 动 态 模型 的 性 质 6.5， 有 
H(q)v *C(q, d)v *t«(q) -Y(q, d, v ,v)a 
(6. 87) 
RP, Ye, su ru 0) 是 一 个 已 知 时 间 函 数 的 
(nxr) 矩阵 。 式 (6.87) 和 自 适 应 计算 转 抢 控制 的 
参数 分 离 方法 的 公式 是 同类 型 的 。 注 意 ,，Y(g，Y， 


v, v) 是 独立 于 关节 加 速度 的 。 类 似 式 (6.87), 
我 们 得 到 


H(q)v +C(q, d)v «&(q) -Y(q, d, v, v)à 
(6. 88) 


把 控制 输入 代入 运动 方程 ， 得 到 
H(q)q +C(q, q)q +T(p) = 


H(g)v +C(q, d)v «&«(q) + Kos 


前 面 的 结果 能 重 写成 


由 于 了 =v -s, q=0-s, 


H(q)s * C(q, q)s * Kys 2 Y(q, q, vU, v)a 


(6. 89) 
XP, a =4-a。 自 适应 法 则 认为 是 
a = -IY'(q, q,v, v)s (6. 90) 


跟踪 误差 收敛 到 零 的 边界 上 所 有 内 部 信号 可 以 通过 李 
雅 普 诺 夫 稳 定性 理论 表示 ,使 用 下 面 类 似 李 雅 普 诺 夫 
函数 的 函数 


V= 3s"H(g)s sra rn a (6.91) 
它 沿 闭环 系统 的 轨迹 的 时 间 导 数 为 
V = -s"K,s (6.92) 


详细 的 稳定 性 分 析 参 见 参考 文献 [6.32]. 
ik: 
1) 之 前 学 到 的 自 适 
里 被 去 除了 。 
2) Kos 项 给 
定 控 制作 用 。 
3) 如 果 参 考 轨迹 满足 以 下 持续 激励 条 件 ， 则 参 
考 轨 迹 的 估计 参数 收敛 于 真实 参数 。 


HIE 4 . . . . 
at, < | Y'(q,, qas v, v)Y(q,, qav, v )dt 
0 


应 计算 转 矩 控制 的 限制 在 这 


全 误差 系统 模型 引入 了 PD 型 线性 稳 


xo,, 


其 中 ， 所 有 的 1 ，a,，a,;， 和 +1 都 是 正常 数 。 
6.7.3 被 动 自 适应 控制 
从 控制 的 物理 学 角度 我 们 能 看 到 ， 由 于 自 适应 控 


制 方案 的 发 展 ， 被 动 性 的 概念 变 得 很 普及 。 在 这 里 会 
说 明 被 动 性 的 概念 是 怎样 运用 到 设计 一 种 机 器 人 机 械 
臂 自 适应 控制 法 则 类 型 中 的 。 首 先 要 定义 一 个 辅助 滤 
波 跟踪 误差 信号 r 为 

r=F"' 


(s)e, (6.93) 
其 中 ， 


(6.94) 


Fo'(s) = [L6] 
XB, s 是 拉 普 拉 斯 变换 变量 。 选 择 (nxn) 的 和 矩阵 
K(s), fli F(s) 是 一 个 完全 合适 、 稳 定 的 传递 函数 算 
阵 。 如 之 前 的 方案 ， 自 适应 控制 策略 和 将 已 知 函 数 从 
未 知 常数 参数 中 分 离 出 来 的 能 力 有 密切 的 关系 。 使 用 
上 述 的 公式 定义 

Ze-H(q)| q,*K(s)e,] -V(q, 4) 
| Kise, ] eco 


式 中 , Z 是 已 知 的 (axr) 回归 矩阵; o 是 自 适应 环 
境 中 未 知 系统 参数 的 一 个 向 量 。 注 意 到 上 式 可 以 改 
写 ， 使 Z 和 r 能 不 依赖 于 关节 加 速度 q 是 很 重要 的 。 
这 里 的 自 适应 控制 方案 称 为 被 动 性 方法 ， 是 因为 
-roZe 的 映射 被 构造 为 被 动 映射 。 即 ,我 们 得 到 
了 一 个 自 适 应 法 则 ， 有 


[ -rf(e)Z(c)e(ec)de 2-8 (6.95) 


满足 某 个 正 纯 量 常数 B。 这 类 自 适 应 控制 融 的 控 
^3 


a 
= 


=Z9+K,, r 

详细 的 稳定 性 分 析 参 见 参考 文献 【6.44] 。 

备注 

1) 如 果 选 取 K(s)， 
Z 和 7 将 不 依赖 于 4 。 

2) 通过 在 定义 r 中 选择 不 同 的 传递 函数 矩阵 
K(s)， 可 以 由 自 适应 被 动 控制 方法 产生 多 种 控制 方 
案 的 类 型 。 

3) 注意 ,定义 K(s) = sA, f F(s) =(s n+ 
A), Fil AA 


(6.96) 


WBA H(s) 有 一 个 相对 度 ， 


T=Z0-K,r 


=i 


Ze-H(q)( d *Ae,) «C(q, d) (d, Ae) &.(q) 
自 适应 法 则 可 能 被 选取 为 


e -IZ'(e, +Ae,) 
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以 满足 被 动 映 射 条 件 。 这 表明 自 适应 惯性 相关 控制 可 
以 看 作 是 自 适应 被 动 控制 的 特例 。 
6.7.4 具有 期 望 补偿 的 自 适 应 控制 

为 了 实现 自 适 应 控制 方案 ， 需 要 实时 计算 Yq, 
q, q) 的 元 素 。 然 而 ， 这 个 过 程 会 非常 浪费 时 间 ， 
因为 它 涉及 关节 位 置 和 速度 的 高 次 非 线性 函数 的 计 
算 ， 因 此 ， 这 种 方案 的 实时 实现 是 相当 困难 的 。 为 了 
克服 这 些 困 难 ， 这 里 提出 并 讨论 了 带 期 望 补偿 的 自 适 
应 控制 。 换 言 之 ， 用 期 望 变量 替换 变量 g, q 和 9 ， 
即 ， qlas qa All Gao 因 2 望 量 是 前 已 知 的 ， 所 
以 它们 相应 的 计算 可 以 离线 进行 ， 使 得 实时 实现 似乎 
更 可 行 。 我 们 考虑 控制 输入 

T-Y(q,, qa, d a ks +k e, +h, lle, [Ps 

(6.97) 

HWS s 定义 


RP, ERX k, k,, Mk EK; 
As=e,te,. 自 适 应 法 则 认为 是 


a= -I'Y'(q, dq, ds (6.98) 
值得 注意 的 是 ， 在 控制 和 自 适应 法 则 中 采用 了 期 望 补 


详细 的 稳定 性 分 析 参 加 参考 文献 [6.45]。 
小 结 和 扩展 阅读 


由 于 计算 转 矩 控制 容许 参数 的 不 确定 性 ， 因 此 提 
出 了 多 种 自 适应 控制 方案 。 首 先 介 绍 了 基于 计算 转 矩 
控制 的 自 适应 控制 方案 。 然 后 为 克服 之 前 提 及 的 不 
足 ， 如 关节 加 速度 的 可 测量 性 和 估计 惯性 矩阵 的 可 首 
性 ， 我 们 介绍 了 一 种 没有 这 些 不 足 的 替代 的 自 适应 控 
制 方案 。 最 近 ， 控 制 中 吸收 了 物理 学 的 观点 ， 自 适应 
被 动 控制 变 得 普及 了 ， 所 以 在 这 里 介绍 和 讨论 一 下 。 
最 后 ， 为 了 减少 自 适应 方案 的 计算 负荷 ， 我 们 介绍 了 
期 望 补偿 的 自 适应 控制 。 

参考 文献 【6.46] 中 提出 了 一 种 处 理 刚性 机 械 
辟 问 题 的 自 适应 控制 的 快速 计算 方案 。 通 过 假定 关节 
动力 学 是 解 耦 的 〈 如 每 个 关节 被 认为 是 一 个 独立 的 
二 阶 线性 系统 ) ， 完 成 稳定 性 分 析 。 这 一 领域 的 其 他 
开创 性 的 工作 可 以 找到 ， 比 如 ， 在 参考 文献 [6.47, 
48] 中 ， 尽 管 基础 的 动力 学 模型 性 质 一 个 也 没 使 用 ， 
却 还 是 考虑 到 了 完整 的 动力 学 ， 但 是 控制 输入 是 不 连 
续 的 ， 会 引起 抖 振 。 虽 然 假 定 自 适应 中 某 个 时 变量 保 
持 为 常数 ， 在 参考 文献 【6.49] 节 中 明确 使 用 了 惯 
性 矩阵 的 正定 性 。 很 有 意思 的 是 所 有 的 这 些 方案 都 是 


6.7.5 


Hb 


ri 


aj 


偿 ， 使 计算 负荷 大 大 减少 。 便 于 分 析 起 见 ， 我 们 注 
意 到 


| YCq, q, q )a - Y(q,, qa, q alls 
£, lle, l+ lle, IP +2; Ils ]+Z, Ilsillle, ll 
RF, L, G, G, Ml, 是 正常 数 。 为 了 实现 轨迹 跟 


Es, WE. 


k, >on +04 
&á 65 
ase 


4 图 
k, persi ips 


(PMN, Hak, kp, Mk, 值 应 该 足够 大 ) 。 李 雅 普 
诺 夫 稳定 性 理论 和 下 面 的 与 李 雅 普 诺 夫 方 程 类 似 的 方 
程 能 证 明 内 部 信号 的 边界 内 的 跟踪 误差 收敛 于 零 。 


l r 1 ï Í ene 
V=3s H(q)s +5 keget Fa Ta (6.99) 


其 中 ， 沿 着 闭环 系统 的 轨迹 的 时 间 导 数 推导 为 


k 


V < -x'Qx (6. 100) 


-£,/2 
mae 


PE , 


n) 2 po 
m $ = 
IIs | ae 


基于 参考 文献 [6.50] 中 为 线性 系统 提出 的 模型 参 
考 自 适应 控制 (MRAC) 概念 。 因 此 ， 概 念 上 它们 与 
本 节 所 介绍 的 真实 非 线 性 方案 十 分 不 同 。 

参考 文献 [6.51] 和 [6.52] 中 ,提出 了 一 种 
基于 被 动 性 的 修正 版 的 最 小 二 乘 估计 方案 ， 它 确定 了 
方案 的 闭环 稳定 性 。 在 参考 文献 [6.53] 能 找到 其 
他 方案 ， 其 中 没有 用 到 反对 称 性 质 。 在 参考 文献 
[6.54] 中 ,递归 的 牛顿 - 欧 拉 方程 用 来 代替 拉 格 朗 
日 方程 推导 机 械 辟 的 动力 学 方程 ， 因 此 ， 简 化 的 计算 
帮助 了 实际 应 用 。 
虽然 自 适应 控制 提出 了 解决 参数 不 确定 性 问题 的 
方法 ， 但 是 自 适应 控制 器 的 鲁 棒 性 问题 在 这 一 领域 仍 
是 一 个 非常 有 趣 的 课题 。 确 实 ， 测 量 噪声 或 未 建 模 动 
力学 ( 如， 柔性 ) 会 产生 无 界 的 闭环 信号 。 特 别 地 ， 
估计 参数 会 发 散 一 一 这 是 自 适应 控制 中 一 种 众所周知 
的 现象 ， 称 为 参数 漂移 。 参考 文献 [655] 和 
[6.56] 中 研究 了 由 线性 系统 自 适 应 控制 得 出 的 方 
法 ， 其 中 修正 的 估计 值 确定 估计 值 的 边界 。 在 参考 文 
献 [6.57] 中 , 为 了 加 强 鲁 棒 性 ， 修 正 了 参考 文献 
[6.32] 中 的 控制 高。 


6.8 最 优 和 重 棒 控 制 


已 知 一 个 非 线性 系统 ， 例 如 机 器 人 机 械 臂 ， 人 


122 第 1 篇 


机 器 人 学 基础 


们 能 够 设计 许多 稳定 化 的 控制 器 “*" i。 换言之 ， 
控制 系统 的 稳定 性 不 能 确定 一 个 唯一 的 控制 器 。 很 
自然 地 ， 人 们 在 许多 的 控制 器 中 寻找 一 个 最 优 的 控 
制 器 。 然 而 ， 只 有 在 有 目标 系统 相当 精确 的 信息 情 
况 下 ， 例 如 精确 的 系统 模型 ， 一 个 最 优 的 控制 融 设 
计 才 是 有 可 能 的 “*”*。 当 存在 实际 系统 与 其 数学 
和 
再 是 最 优 的 ， 甚 至 可 能 在 真实 系统 中 最 终 是 不 稳定 
的 。 一 般 来 说 ， 最 优 控制 设计 架构 并 不 是 解决 系统 
不 确定 性 最 好 的 一 个 。 为 了 处 理 控制 设计 阶段 的 系 
统 不 确定 性 ， 需 要 一 个 鲁 棒 控制 设计 架构 “”。 和 鲁 
棒 控 制 的 主要 目标 之 一 是 即使 数学 模型 或 未 建 模 的 
动力 学 等 中 存在 不 确定 性 ， 也 要 保持 所 控制 系统 的 

考虑 一 个 由 如 下 非 线性 时 变 微 分 方程 描述 的 仿 射 
非 线性 系统 ， 其 中 


x-(x,x,-,x,) eR" 


x(t) 2f(x, t) +G(x, DusP(x,t)w (6.101) 
RP, we R” 是 控制 输入 ; we R" 是 扰动 。 不 考虑 扰 
动 或 未 建 模 动 力学 ， 系 统 简 化 为 

x(t) =f(x, t) +G(x, t)u (6. 102) 
实际 上 ， 根 据 控制 目标 存在 许多 种 描述 非 线性 系统 的 
方法 区 1,16.21,23,34,53] " 


二 次 型 最 优 控制 

每 一 个 最 优 控 制 器 都 是 基于 它 自 己 的 成 本 也 

数 e%al 。 我 们 可 以 这 样 定义 它 的 成 本 函数 ee 
z-H(x, t)x+K(x, t)u 

Æ H'(x, i) K(x, t) 20, K'(x, t) K(x, t) = 

R(x, 1) >0, H. H'(x, 1) H(x, 1) 2Q(x, 1) 50, 

于 是 有 


AN 


=> 


6. 8.1 


drola" ly 
245 t= Hx Q(x, t)x+ z7“ R(x, t)u 


对 于 一 个 一 阶 可 微 正定 函数 ， 通 过 解 以 下 汉 密 尔 
顿 - 雅 可 比 -贝尔 曼 (HJB) FFEN, MAREA 
统 的 二 次 最 优 控 制式 (6. 102)。 

0 - HJB(x, t; V) =V,(x, t) +V, (x, t)f(x, t) 


-V(x t)G(x, t)R (x, t) 
G' (x, t) VH (x, L) + 9G. t) 


TEE 2 
式 中 ， V3 irm 


于 是 这 个 二 次 最 优 控制 可 定义 为 


u= -R(x,1)G (x, 1)V (x, t) (6. 103) 
注意 HIB 方程 是 一 个 非 线 性 二 阶 偏 微分 方程 。 
不 像 之 前 提 过 的 最 优 控制 问题 那样 ， 所 谓 的 道 二 
次 最 优 控 制 是 为 了 找到 一 组 Q(x, t) 和 R(x, t), 
使 得 HJB 方程 有 解 V(x，t)。 首 二 次 最 优 控 制 于 是 可 
以 定义 为 式 (6. 103)。 

6.8.2 JERTEH. 控制 
当 扰 动 无 法 忽略 的 时 候 ， 可 以 这 样 来 处 理 扰 动 


作用 


[es T)z(x, T)dT < rf w'wdT (6. 104) 


AP, y>0 给 定 了 从 扰动 输入 w 到 成 本 变量 z 的 闭 
环 系统 的 疡 增益 。 这 被 称 为 L 增益 的 衰减 要 求 。 非 
线性 J€. 最 优 控制 给 出 了 一 种 设计 最 优 和 重 棒 控 制 的 
系统 化 方法 。 令 y >0 已 知 ， 解 以 下 方程 : 

HJI, (x, t; V) 2 V, (x, t) +V, (x, 0f(x, t) 


-V(x, t){G(x, DR! 
(x, 1)G'(x, t) -y ?P(x, t) 
P(x, DIV (x, t) + FOC, t) <0 


(6. 105) 
于 是 控制 定义 为 ; 
u--R(x,1)G (x, t)Vi(x, t) (6.106) 
这 个 偏 微分 不 等 式 被 称 为 汉密尔顿 -雅克 比 - 艾 
萨 克 (HJI) 不 等 式 。 那 么 ， 可 以 定义 逆 非 线性 Ho 
最 优 控制 问题 ， 该 问题 可 以 找到 一 组 C(z，:) 和 
R(x, t), EXI T EXE BS L, 增益 y， 达 到 了 L, 
HAERES, 
有 两 件 事 值得 进一步 讨论 。 第 一 ，L, 增益 要 求 
只 对 万 范 数 ( 欧 几 里 德 距离 ) 是 有 界 的 扰动 信号 w 
有 效 。 第 二 , Ho 最 优 控 制 的 定义 不 是 唯一 的 。 因 此 ， 
我 们 可 以 从 众多 的 He 最 优 控制 器 中 选 出 一 个 二 次 最 
优 的 。 准 确 地 说 ， 由 于 期 望 的 增益 是 指定 的 先 验 ， 
那么 这 个 控制 (6.106) 应 该 被 称 作 Ho 的 次 优 控 制 。 
一 个 真正 的 He 最 优 控制 是 找到 使 L, 增益 要 求实 现 
的 y 为 最 小 值 。 


6.8.3 ” 非 线 性 ,控制 的 被 动 设计 


有 许多 设计 最 优 和 (或 ) 鲁 棱 控制 的 方法 。 其 
中 , 被 动 控 制 可 以 充分 利用 上 面 所 描述 到 的 性 
质 “”"。 它 包括 两 部 分 : 一 个 来 自 保留 了 系统 被 动 性 
的 参考 运动 补偿 ， 男 一 个 则 要 达到 稳定 性 、 重 棒 性 和 
(或 ) 最 优 性 1。 
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假设 ,动力 学 参数 被 确定 为 H(q) C(q 4) 根据 这 种 方法 ， 辅助 控制 输入 是 指定 的 ， 被 动 
l i . 控制 可 实现 稳定 性 、 和 鲁 棒 性 和 (或 ) 最 优 性 。 
和 Ts(g)， 它 们 的 对 应 部 分 分 别 是 H(q), Clq, q) . NEN -— 
和 ri(4g)。 那 么 ， 被 动 控制 会 产生 下 面 的 跟踪 控制 9.8. 4 ^ REESE GE, 控制 问题 的 解决 方案 
法 则 : 通过 参考 误差 反馈 定义 辅助 控制 输入 
T=H(q) IT +C(g, 1) Gee +t(g) -u u= -aR^ (x, ie (6. 111) 
(6.107) 其 中 ,a >1 是 任意 的 。 那 么 ， 控 制 提供 了 逆 非 线性 
式 中 ， 亿 ,是 参考 加 速度 ， 定 义 为 ; He SUBE 
Gc = qQ, +K, e, + Kye, (6. 108) 定理 6. 1， 逆 非 线性 Fe. 最 优 人 性 ce， 
stp, K, = diagg| ky, i} >0; K, =diag{k,, i} »0, 


参考 加 速度 产生 中 涉及 两 个 参数 。 有 时 可 以 采用 下 面 
的 替代 方法 : 
l= 1 tKye, 
这 减少 了 闭环 系统 的 阶 数 ， 因 为 当 式 (6. 108) 
的 定义 要 求 状态 x = (fet ,er 27) 时 ,状态 x = Cen 


q?"*q? 


e.) ”对 于 系统 描述 是 充分 的 ， 控 制 下 的 闭环 动力 学 
由 下 式 给 出 
H(q) € 


wt C(q, q)ên=u+w (6.109) 


Ao) diet + C (q.d) årer 


"3 E eref 
H (q) ret + C(q, d) eref 


a(é ref) 


图 6.7 根据 公式 (6.109) 的 闭环 系统 


F 


€, 7 €,+Kye,+K,e 


P 9 


eu 三 e. + Kye at K, je, 


如 果 d(t) = 0, HA=H, C=C, t%=t%, 则 w=0。 
否则 ， 扰 动 定义 为 


w=H(q)q 


+C(g, 1) Ar tTa) +d(t) 

(6. 110) 
式 中 , H-H-H; C-C- C; 5-6 -T 特别 有 
意思 的 是 ， 该 系统 (6.109) 定义 了 从 w+w Fl e.g 
被 动 映射。 


使 参考 加 速度 产生 增益 矩阵 K 和 大， 满足 
K, >2K, (6. 112) 
那么 ， 对 于 一 个 给 定 的 y > 0， 参 考 误差 反馈 


u--Ke,--K (e, + Kye, +K, |e, ) 


(6. 113) 
对 于 
KiK, 0 0 
Q-| 0 (K\-2K,)K, 0 | (6.114) 
0 0 K, 
R=K"' (6. 115) 
满足 L 增益 衰减 要 求 。 
其 中 K,=K-+1>0 (6. 116) 
y 
AXE y, AWK =a ig Ha>l, #2 K, = 
y 
Cant 
Y 


当 惯 性 矩阵 被 确定 为 对 角 常数 和 矩阵 后 ， 如 五 = 


diag|m;| ， 应 该 设 C=0。 此 外 ， 可 以 设 完 =0。 则 推 
HY fS PID 控制 的 表达 式 : 


T= m( ga, +h + hp ie, ;) 


V, ie qi 


1 
iro + ky je ifq, i th, fi ) 
当 a >1 时 ， 上 式 可 以 重 写 为 


nu A 1 \， 
T; =m; da, 十 (5.5... d. eii 


^ ky ; Pi 
+| mk, +oa— Jeg, T&T] Cy, i 
vy 


(6. 117) 
这 就 推出 了 有 具有 期 望 加 速度 前 馈 的 PID fane 97 . 


+ kp desi 


T = mqa; +h (6. 118a) 


ida,i V, ifq, i 


其 中 ， 


thy ile, ; 


机 器 人 学 基础 


124 第 1 篇 
^ 1 
ky ;2mjk,;ta— (6. 118b) 
y 
ky ; 
kp ; =m,kp ; +a — (6. 118c) 
y 
* kp; 
ko za È (6. 118d) 
; y. 


6.9 ”数字 化 实现 


前 面 介绍 过 的 控制 器 ， 大 多 数 都 可 以 在 微 处 理 融 
上 数字 化 地 实现 。 本 节 讨 论 基本 但 是 实质 的 计算 机 实 


样 周期 下 的 输出 。 由 于 采样 会 在 控制 闭环 中 引入 时 间 
延迟 ， 因 而 这 是 与 模拟 实现 相 比 的 一 个 不 足 之 处 。 图 
6. 8 展示 了 有 数字 化 实现 的 控制 系统 的 总 框图 。 当 用 
数字 计算 机 实现 控制 法 则 的 时 候 ， 很 方便 用 中 断 程序 
将 代码 序列 分 成 四 个 过 程 程序 ， 如 图 6.9 所 示 。 以 正 
确 的 频率 从 传感器 读 取 输 入 信和 号， 同步 将 控制 信号 写 
到 数 模 (D/A) 转换 融 是 非常 重要 的 。 因 此 ， 这 些 过 
程 放 在 第 一 个 程序 中 。 在 存储 了 计数 器 的 值 并 提取 了 
D/A 值 后 (这 些 值 已 经 在 上 一 步 计算 过 ) ， 下 一 步 程 


序 将 产生 参考 值 。 带 滤波 的 控制 程序 遵循 并 产生 纯 量 


现 相 关 的 实践 问题 。 当 控制 器 是 在 计算 机 控制 系统 中 
完成 的 时 候 ， 读 取 的 是 模拟 输入 ， 输 出 为 一 个 特定 采 


或 向 量 的 控制 输出 。 最 后 ， 给 出 检查 参数 值 的 用 户 接 
口 ， 并 被 用 来 调节 和 调试 。 


图 6.8 系统 控制 的 数字 化 实现 


编码 器 访问 


Control_interrupt() 
D/A，A/D 访 问 { 

Read Write(); 
Reference Generate(); 
Output. process(); 


Output. Debug(); 


图 6.9 数字 控制 中 断 程序 的 序列 


6.9.1 参考 轨迹 生成 


参考 轨迹 生成 是 一 个 起 点 ， 用 做 控制 的 目标 值 。 
它 是 一 组 在 控制 处 理 器 中 每 个 中 断 的 设 定点 的 值 ， 所 
以 被 称 作 运动 轮廓 。 既 然 实际 上 此 时 伺服 控制 的 目标 
不 是 点 对 点 控制 ， 而 是 轨迹 跟踪 ， 那 么 设计 好 这 个 轮 
廊 就 非常 重要 了 ， 因 为 跟踪 和 定位 误差 对 此 十 分 敏 
感 。 一 般 梯形 轮廓 是 很 好 计算 的 ， 在 加 速 和 减速 期 间 
需要 恒定 电流 。 然 而 ， 运 动 两 端 发 生 大 的 拌 动 会 引起 
振动 。 大 的 拌 动 (加 速度 的 迅速 改变 ， 及 相应 的 力 
的 迅速 改变 ) 可 能 会 对 动力 学 系统 造成 实质 性 损害 
和 引起 不 希望 的 振动 。 因 此 ， 需 要 平滑 的 轮廓 ， 尽 管 
这 需要 更 多 的 计算 时 间 。 一 个 使 用 三 次 多 项 式 的 简单 


y(t) =a * bt +c? +d? 


y (1) =b +2ct «3d 
y (t) 22e +6dt 
实际 上 上， 运动 轮廓 方程 是 标准 化 的 ， 并 且 可 以 编 
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EHRM, HRN: Nm 
y(0) 20, y(1) =1 ' p ' 
x Yr AY + Yy-2 
y(0) =0, y(1) =0 aa 3 (6. 121) 
当 运 动 时 间 和 距离 是 标准 化 的 时 候 ， 程 序 代 码 采 E^ yi -73yyai SE 
e AP 


用 式 (6.119) 中 所 示 的 式 子 。 


Ge) BG) 0) Ee 


(6. 119) 


式 中 ,5 代表 上 距离, 了 代表 运动 时 间 。 

对 于 高 速 伺服 系统 ， 拌 动 轮廓 在 运行 的 开始 和 结 
束 是 不 变 的 。 这 意味 着 需要 很 高 的 机 械 刚 度 。 即 使 计 
算 负荷 增加 了 ，15 甚至 17 次 多 项 式 也 可 以 设计 来 满 
足 加 速度 或 拌 动 约束 。 

运动 轮廓 经 常 以 表格 或 中 断 程序 “Reference_ 
Generate ( )” 的 形式 保存 在 只 读 存 储 右 (ROM) 中 ， 
如 图 6.9 所 示 。 在 大 多 数 跟踪 伺服 控制 问题 中 ， 需 要 
生成 位 置 轮廓 。 但 是 ， 速 度 和 加 速度 也 在 中 断 程 序 中 
实时 计算 ， 用 做 前 馈 控 制 的 输入 。 这 些 方法 改善 了 跟 
踪 性 能 ， 其 算法 如 下 : 


Pos, = PosTable( pointer) x Distance ; 


Vel, = Pos, — Pos, oup (6. 120) 


Acc, = Vel, — Velia oun 


IP, Vel, 4cc 并 不 是 实际 参考 速度 和 加 速度 ， 
它们 分 别 表 示 在 实际 使 用 中 与 中 断 时间 间 隔 成 比例 的 
参考 速度 以 及 与 中 断 时 间 间 隔 的 平方 成 比例 的 加 速 
度 。 此 外 ， 当 使 用 在 式 (6.120) 中 的 简单 差分 公式 
从 位 置 轮廓 计算 速度 轮廓 时 ， 由 于 重要 数字 信和 号 的 丢 
失 ， 数 字 信 和 号 处 理 器 (DSP) 或 处 理 器 的 有 限 的 寄存 
器 大 小 可 能 引起 误差 。 这 意味 着 ， 速 度 轮廓 中 含有 周 
期 性 的 噪声 信号 。 当 速度 、 加 速度 和 抖动 的 轮廓 用 做 
高 速 跟踪 的 前 馈 控 制 系统 的 输入 时 ， 这 种 数字 误差 将 
在 运动 中 产生 真实 的 噪声 ， 并 且 降 低 控制 系统 的 
性 能 。 

可 以 使 用 数值 微分 方程 ， 而 不 用 式 (6.120) 中 
的 简单 差分 。 方程 (6.121) 给 出 了 一 阶 向 后 -差分 
方程 的 最 简 形 式 : 


如 果 存 储 容量 足够 大 ， 以 表格 的 形式 保存 每 个 轮 
廓 可 能 是 男 一 种 好 方法 。 

重要 的 是 ， 所 控制 的 系统 运动 的 最 大 的 规格 参 
数 ， 如 ， 速 度 或 加 速度 ， 或 者 甚至 是 抖动 ， 应 该 在 轮 
廓 设计 步 又 中 了 予以 考虑 。 如 果 轮 廓 强迫 系统 超出 最 大 
规格 参数 值 ， 由 于 编码 器 脉冲 值 的 丢失 ， 会 大 大 增加 
系统 发 生 碰 撞 事 故 的 可 能 性 。 


6.9.2 代码 的 Z 变换 


通过 使 用 Z 变换 可 以 将 连续 时 间 系 统 变换 到 离 
散 时 间 系 统 。 尽 管 物理 过 程 仍 然 是 一 个 连续 时 间 系 
统 ， 但 是 ， 离 散 时 间 系 统 用 于 获取 采样 点 处 给 出 物理 
过 程 行为 的 数学 模型 。 拉 普 拉 斯 变换 用 于 分 析 在 S 域 
上 的 控制 系统 。 在 大 多 数 情况 下 ， 控 制 咒 和 滤波 器 的 
设计 都 使 用 了 在 $ 域 上 的 工具 来 完成 。 为 了 使 用 程序 
代码 来 实现 这 些 结 果 ， 了 解 Z 变换 是 必 不 可 少 的 。 
所 有 在 S 域 上 设计 的 控制 器 和 滤波 器 都 可 以 容易 地 通 
it Z 变换 编译 成 为 一 段 程 序 代码 ， 这 是 因为 它 有 数 
字 化 的 差分 序列 公式 。 
以 一 个 编码 的 PID 控制 器 为 例 。 在 传递 函数 的 式 

中 ， 这 种 控制 需 的 基本 结构 是 
Y(s) 


e iu. (6.122) 
E(s) s y 
从 频 域 到 离散 域 的 转换 有 几 种 不 同 的 方式 。 为 了 
保持 稳定 性 ， 经 常 使 用 向 后 欧 拉 算法 和 塔 斯 汀 算法 。 
虽然 塔 斯 汀 算法 被 认为 是 一 种 更 为 准确 的 算法 ， 但 是 
下 面 采用 了 向 后 欧 拉 算法 。 
把 向 后 欧 拉 方程 代入 式 (6.122) , ， 有 
;= 
得 到 下 面 的 离散 式 
Y(z Qa+Bz +yz” 
De - aet (6.123) 
其 中 ， 


o -KT -K,T «Ky; 
B= -K,T -2K,; 
y2Ky. 
现在 ， 可 以 用 差分 方程 重新 整理 为 : 
T(y,—-y,.4) = ae, * Be, + Ye,_» 


126 第 1 篇 


机 器 人 学 基础 


1 
VE = YE urat ae, * Be, , + ye, 2) 


y, 7 Yra = 3 T^ | Ben à Tta (6.124) 
这 个 公式 可 以 直接 被 编译 为 代码 
ek = Px, yat 一 有 
e; = Vh, ref — 0, 


= (Pi, ref 7 Pk-1, ref) 一 (p, 7 pii) 


=e, Ei 
k 


sum, = sun, , +e, = Xe, 
j-0 
Yr = Kp, ej + Ky, (e, 76,4) +K, sum, 


Yr —Yr-1 = (Kp, oer 7 Kp, 64.1) 
+[ Ky (e; 76a)] 
- [Ky (es1 -er-2)] 
+ (K, .sum, - K, ,sum, ,) 
=(K, + Ky. + Ky. ey 
— (Ky, €2K, er + Ky Les 
(6.125) 
式 中 ,p, 是 现在 的 位 置 ; v, 是 当前 速度 ;下 标 ref 代 
RES; 下 标 。 代表 代码 。 比 较 式 (6.124) 和 式 
(6.125) 的 参数 ， 可 得 


天 
pK t Kil = (K, o +Ky, + Ki, o) 
2K 
P = -人 pU (Ks F2K, 。) 
K 
Wa X 
Tp 
这 表明 在 增益 的 设计 和 编码 的 式 子 之 间 存 在 关联 : 
K, = Kp 
K 
Ky = 
K .=KT (6. 126) 


随 着 同一 系统 中 采样 频率 的 增加 ， 编 码 的 K, 增 
益 应 该 增加 ， 同 时 编码 的 K 增益 应 该 降低 。 使 用 这 
种 方法 所 设计 的 控制 器 可 以 在 DSP 或 微 处 理 器 中 进 
行 编译 。 尽 管 如 此 ， 对 于 控制 算法 的 分 析 和 仿真 应 该 
事先 充分 演算 ， 才 能 得 到 控制 系统 的 优异 表现 。 


6.10 ”学 习 控制 


由 于 许多 机 器 人 应 用 ， 比 如 拾取 与 放置 操作 、 喷 
潜 、 电 路 板 组 装 等 等 ， 都 涉及 重复 性 的 运动 ， 人 们 自 
然 会 考虑 利用 以 往 周 期 中 收集 的 数据 来 改善 机 械 辟 在 
随后 周期 中 的 性 能 。 这 就 是 “重复 控制 ”或 “学 习 


控制 ”的 基本 理念 。 考 虑 在 6. 1 节 中 给 出 的 机 器 人 模 
型 ， 并 假设 给 定 一 个 在 有 限 的 时 间 间 隔 0<t1<7 内 
的 期 望 的 关节 轨迹 gq,(1)。 参 考 轨 迹 qu 被 用 在 机 械 臂 
的 重复 轨迹 中 ， 这 里 或 者 假设 运动 轨迹 是 周期 性 的 ， 
qa(T) =q,(0) ( 即 重复 控制 ) ， 或 者 假设 机 器 人 在 每 
次 轨迹 的 开始 都 被 重新 初始 化 ， 使 之 位 于 期 望 轨迹 上 
( 亦 即 学 习 控制 )。 下 文中 ,我 们 将 用 “学 习 控制 ” 
这 个 词 代表 “重复 控制 ”或 者 “学 习 控 制 ”。 


6.10.1 纯 P 型 学 习 控 制 


用 五 表示 第 左 个 周期 中 的 输入 转 矩 ， 并 产生 输 
出 q.(1)， 其 中 0 <t<T,,0 现在 我 们 考虑 如 下 假设 : 
1) 假设 1: 每 次 实验 都 在 固定 的 时 间 期 限 Tuw > 
0 时 结束 。 
2) 假设 2: 满足 初始 设置 的 重复 性 。 
3) 假设 3: 整个 重复 轨迹 中 系统 的 动力 学 不 变 
性 是 确定 的 。 
4) 假设 4: 每 个 输出 和 都 是 可 测量 的 ， 从 而 误 
差 信号 Aq, = q, -qi 可 以 用 来 构造 下 一 个 输入 Ti,1。 
5) 假设 5: 机 器 人 机 械 臂 的 动力 学 是 可 逆 的 。 
由 此 学 习 控 制 问题 被 归结 为 确定 一 个 递归 学 习 法 


Wu L 
Tisi SLET, (t), Ag,(t)], Ot T, — (6.127) 
XP, Ag,(t) 24,00 -qa(t)， 使 得 在 某 些 适当 定 
SCHY PR CI BEF || + ||, = ko 时 ，||Agil 王 0。 
初始 控制 输入 可 以 是 任何 一 个 能 够 产生 稳定 输出 
的 控制 输入 ， 比 如 PD 控制 。 这 样 的 学 习 控 制 方案 
之 所 以 有 吸引 力 ， 是 因为 动力 学 的 精确 模型 不 需 
要 是 先 验 的 。 
已 经 有 几 种 方法 用 来 得 出 一 个 适当 的 学 习 法 则 
工 ， 以 及 证 明 输 出 误差 的 收敛 性 。 纯 P 型 学 习 法 则 是 
其 形式 之 一 : 
T, (t) zT, (t) — BAq,(t) (6.128) 
之 所 以 起 了 这 个 名 字 ， 是 因为 在 每 次 迭代 的 过 程 中 ， 
输入 转 矩 的 修正 项 都 是 和 误差 Ag, 成 正比 的 。 现 在 让 
五 用 计算 转 矩 控制 来 定义 ， 亦 即 ， 
T(t) -H|qu() ] g 40) +C[9q CD， 
Gat) 1440) T [qu] (6. 129) 
应 该 记得 ， 函 数 五 实际 不 需要 计算 的 ， 只 需要 知道 
它 存 在 即 可 。 对 于 了 型 学 习 控 制 法 则 ， 我 们 有 
AT, (t) =AT,(t) -BAg,(t) (6.130) 
HP, AT) TTG) -Tu(1)， 使 得 
[A Tt. CO IF [A m CO IP -Bll BA) E 
(6.131) 
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如 果 存 在 正常 数 和 A MB, ARTIR k, A 6.3 R.J. Schilling: Fundametals of Robotics: Analysis and 

Phd 1 Control (Prentice-Hall, Upper Saddle River 1989) 
| e “Ag AT, (1) dt = * Bag, (1) IP 6.4 L. Sciavicco, B. Siciliano: Modeling and Control of 
0 2 i Robot Manipulator (McGraw-Hill, New York 1996) 
(6. 132) 6.5 M.W. Spong, M. Vidyasagar: Robot Dynamics and 
Aene eaen Db dE mmo Control (Wiley, New York 1989) 

接 下 来 它 遵循 不 等 式 (6. 132)， 并 在 范 数 意义 上 ， 66 M.W. Spong, F.L. Lewis, CT. Abdallah (Eds.): Robot 

“kow ，Agi 一 0。 这 种 控制 方案 的 详细 稳定 性 分 析 Control (IEEE, New York 1989) 

Be Hk [6.68, 69] 中 给 出 。 6.7 C.H. An, C.G. Atkeson, J.M. Hollerbach: Model-Based 

在 参考 文献 [ , ] iu Control of a Robot Manipulator (MIT Press, Cam- 

He b p E 4 型 党 习 控油 bridge, 1988) 

6.10.2 ESATA P 型 学 习 控制 6.8 R.M. Murray, Z. Xi, S.S. Sastry: A Mathematical In- 
een A: : m troduction to Robotic Manipulation (CRC Press, Boca 
虽然 纯 P 型 学 习 控 制 已 经 达到 了 预期 的 目标 ， 但 Re p 

是 在 实际 情况 下 一 些 严格 的 假设 可 能 是 不 成 立 的 , fj 6.9 T. Yoshikawa: Foundations of Robotics (MIT Press, 

人 ach Et e Cambridge 1990) 
5 vt A E 5 B AR 

如 ， Muti lias 此 外 ， aid 虽然 小 6.10 0. Khatib: A unified approach for motion and 

但 是 不 可 重复 的 动力 学 波动 。 最 终 ， 有 可 能 返回 一 个 force control of robot manipulators: The operational 

(有 界 的 ) 测量 噪声 &,， 比 如 space formulation, IEEE J. Robot. Autom. 3(1), 43-53 

: i : (1987) 
Aq,C) € £i) 2 La, 0) € £, GO) ] - a 0 6.11 J.Y.S. Luh, M.W. Walker, R.P.C. Paul: Resolved- 
(6. 133) acceleration control of mechanical manipulator, IEEE 
_. Trans. Autom. Contr. 25(3), 468—474 (1980) 
Sy es 2. ab Ae > er M. 
因此 ， 学 习 控制 方案 可 能 会 无 效 。 为 了 提高 P 型 学 习 612 s Arimoto, F. Miyazaki: Stability and robustness 
控制 的 鲁 棒 性 ， 在 递 推 式 中 引入 一 个 遗忘 因子 of PID feedback control for robot manipulators 
E of sensory capability. In: Robotics Research, ed. 
Tia (0) = (1 —a) T(t) + To(t) by M. Brady, R. Paul (MIT Press, Cambridge 1984) 
-P| Ag,(t) *£,(0)]. (6.134) pp. 783-799 
最 初 将 遗忘 因子 引入 学 习 控制 的 想法 来 源 于 参考 文 6.13 L.C. Fu: Robust adaptive decentralized control of 
. robot manipulators, IEEE Trans. Autom. Contr. 37(1), 

Wt [6.70]. 106-110 (1992) 

已 严格 证 明了 ， 带 有 遗忘 因子 的 P 型 学 习 控制 可 ^ 6.15 H.Seraji: Decentralized adaptive control of manip- 
Vata 2 oe le Mr br Za) SHED nt , HA ulators: Theory, simulation, and experimentation, 

DAT AE KAMAE — PEE Oa) 的 邻 域 。 IEEE Trans. Robot. Autom. 5(2), 183-201 (1989) 
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的 幅度 、 动 力学 的 不 可 重复 波动 以 及 测量 噪声 。 详 细 Information Sciences, Vol.289 (Springer, New York 
af 2004) 
ez) Zy xk y-k 
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在 过 去 的 三 十 年 ， 机 器 人 力 
展 。 如 此 广泛 关注 的 动机 ， 来 自 于 对 为 
供 增强 的 感知 能 力 的 普遍 期 望 。 


距离 和 视觉 反馈 
场合 的 非 结构 化 i 


Fr tb EC E 
机 器 人 系统 提 


在 腺 操作 早 


期 的 研究 


来 辅助 人 类 操作 者 使 用 从 机 械 手 来 远程 操作 
近 开发 的 协作 机 器 人 系统 中 ， 


- 作 中 ， 就 设想 利 


期 待 具有 力 、 触 觉 、 
的 机 器 人 ， 能 在 不 同 于 典型 工业 车 间 
环境 中 自主 操作 。 


Wa 


UM. E 


控制 两 个 或 多 个 机 械 手 


( 即 灵巧 机 絮 人 手 的 手指 ) 以 限制 其 相互 作用 力 和 避 
免 挤 压 共同 夹 持 的 物体 。 通 过 在 无 法 预料 情形 下 提供 


智能 响应 和 增强 人 -机 器 人 交互 ， 力 控 人 


ill OF FAF D 


环境 中 实现 机 器 人 系统 的 鲁 棒 和 通用 行为 也 发 挥 着 根 


本 性 的 作用 。 


对 象 或 在 某 个 表面 上 执行 一 些 操作 。 


许多 实际 的 作业 需要 机 器 人 末端 


执行 器 操作 一 个 
对 于 这 些 作 业 的 


成 功 完 成 ， 控 制 机 器 人 与 周围 环境 的 


物理 接触 是 非常 


关键 的 。 工 业 生 产 中 的 典型 例子 包括 打磨 、 去 毛刺 、 


机 加 工 或 装配 。 如 果 再 考虑 非 工业 应 
现 的 状况 是 多 种 多 样 的 ， 因 此 对 可 能 


J, FAFA ABH 
的 机 器 人 作业 进 


行 完 整 分 类 实际 上 是 不 可 行 的 。 而 且 
去 寻找 一 个 与 环境 交互 的 通用 控制 策 
有 用 的 。 

在 接触 过 程 中 ， 环 境 会 在 末端 执 
何 路 径 上 设置 一 些 约束 ， 称 为 运动 学 
表面 接触 的 情况 通常 称 为 约束 运动 。 
情形 可 采用 机 器 人 与 环境 之 间 的 动态 


以 是 惯性 的 比如 在 推 木 块 ) 、 耗 散 的 〈 比 如 在 有 摩 


这 样 的 分 类 对 于 
略 也 并 不 是 真正 


行 器 所 跟随 的 几 
约束 。 对 应 与 便 
其 他 的 接触 作业 
交互 来 描述 ， 可 


擦 表 面 滑 动 ) 或 弹性 的 〈 比 如 在 # 


撞 一 个 弹性 柔顺 
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墙 面 ) 。 在 所 有 这 些 情 形 下 ， 使 用 单纯 的 运动 控制 策 
略 来 控制 交互 是 很 容易 失败 的 ， 下 面 将 进行 解释 。 

若 在 与 环境 交互 的 作业 中 采用 运动 控制 的 方法 ， 
只 有 作业 被 精确 地 规划 时 才能 成 功 执行 。 这 将 需要 机 
器 人 操作 手 〈 运 动 学 和 动力 学 ) 和 环境 ( 几何 和 机 
械 特 性 ) 的 精确 模型 。 一 个 具有 足够 精度 的 机 械 手 
模型 可 以 得 到 ,但 得 到 对 环境 的 详细 描述 却 是 非常 
难 的 。 

为 了 采用 定位 方法 完成 机 械 零件 的 配合 ， 零 件 的 
相对 定位 精度 要 保证 比 零件 机 械 公差 还 高 一 个 数量 
级 。 通 过 这 一 观察 就 足以 理解 作业 规划 精度 的 重要 性 
了 。 一 旦 已 经 准确 得 到 一 个 零件 的 绝对 位 置 ， 机 械 手 
就 应 该 以 同样 的 精度 操纵 其 他 零件 运动 。 

实际 上 ,规划 误差 可 能 引起 接触 力 和 力矩 的 增 
大 ， 导 致 末端 执行 器 偏离 期 望 轨迹 。 另 一 方面 ， 控 制 
系统 做 出 反应 来 减 小 这 种 偏离 。 这 最 终 使 接触 力 逐 渐 
增强 直到 关节 驱动 器 达到 饱和 或 零件 在 接触 部 位 发 生 
破裂 。 

越 高 的 环境 刚度 和 位 置 控制 精度 ， 越 容易 使 上 面 
描述 的 某 种 情况 发 生 。 如 果 在 相互 作用 过 程 中 保证 柔 
顺 行 为 ， 就 可 以 克服 这 个 缺陷 。 和 柔顺 行为 可 以 被 动 或 
主动 方式 实现 。 

1. 被 动 交互 控制 

在 被 动 交互 控制 中 ， 由 于 机 器 人 固有 的 和 柔顺， 机 
器 人 末端 执行 器 的 轨迹 被 相互 作用 力 所 修正 。 柔 顺 可 
能 来 自 于 连 杆 、 关 节 和 末端 执行 器 的 结构 性 柔顺 ， 或 
位 置 伺服 系统 的 柔顺 。 具 有 弹性 关节 或 连 杆 的 柔性 机 
器 人 手臂 就 是 为 了 与 人 固有 地 安全 交互 所 专门 设计 
的 。 在 工业 应 用 中 一 种 具有 被 动 柔 顺 的 机 械 装置 已 被 
广泛 采用 ， 它 就 是 被 称 为 远 中 心 柔 顺 (RCC) BUE 
AUU, RCC 是 一 个 安装 在 刚性 机 器 人 上 的 柔顺 未 端 
执行 器 ， 专 门 为 轴 孔 装配 操作 所 设计 和 优化 。 

被 动 方法 的 交互 控制 是 非常 简单 和 廉价 的 ， 因 为 
它 不 需要 力 / 力 抢 传 感 器 ， 并 且 预 设 的 末端 执行 器 轨 
迹 在 执行 期 间 也 不 需要 改变 。 此 外 ， 被 动 柔顺 结构 的 
响应 远 快 于 利用 计算 机 控制 算法 实现 的 主动 重 定位 。 
但 是 ， 由 于 对 每 个 机 器 人 作业 都 必须 设计 和 安装 一 个 
专用 的 柔顺 末端 执行 器 ， 因 此 在 工业 应 用 中 使 用 被 动 
柔顺 就 缺乏 灵活 性 。 它 也 只 能 处 理 程序 设 定 轨迹 上 小 
的 位 置 和 姿态 偏离 。 最 后 ， 由 于 没有 力 的 测量 ， 它 也 
不 能 确保 很 大 的 接触 力 永远 不 会 出 现 。 

2. 主动 交互 控制 


线 生 成 机 器 人 未 端 执行 器 的 期 望 轨迹 。 
主动 交互 控制 可 以 克服 前 面 提 到 的 被 动 交互 控制 
缺陷 ， 但 是 它 通常 更 慢 、 更 昂贵 、 更 复杂 。 要 获得 合 
理 的 作业 执行 速度 和 抗 干 扰 能 力 ， 主 动 交 互 控制 需要 
与 一 定 程 度 的 被 动 柔顺 联合 使 用 ”1 。 从 定义 可 以 看 
出 ， 反 馈 只 能 在 运动 和 力 误 差 发 生 后 才能 产生 ， 因 此 
需要 被 动 柔 顺 来 保持 反作用 力 低 于 一 个 可 以 接受 的 
BI 

3. AMS 

对 于 一 般 的 力 控 制作 业 ， 需 要 六 个 力 分 量 来 提供 
完整 的 接触 力 信息 ， 即 三 个 平移 力 分 量 和 三 个 力矩 。 
通常 ， 力 /力矩 传感器 安装 在 机 器 人 腕 部 ”“” 。 但 也 
有 例外 情况 ， 比 如 力 传 感 咒 可 以 安装 在 机 器 人 手 的 指 
FETS ， 外 部 的 力 和 力矩 也 可 以 通过 关节 力矩 传 感 
器 对 轴 转 矩 的 测量 来 估计 。 但是， 大 多 数 的 力 
控制 应 用 (包括 工业 应 用 ) 还 是 采用 腕 部 力 /力矩 伟 
感 器 。 在 这 种 情形 中 ， 通 常 假设 安装 在 传 感 需 与 环境 
之 间 的 工具 〈 即 机 器 人 来 端 执 行 器 ) 的 重量 和 惯性 
是 可 以 忽略 的 ,或 者 是 可 以 从 力 / 力 矩 测量 中 适当 地 
补偿 。 力 信号 可 以 通过 应 变 的 测量 获得 ， 即 是 刚性 传 
感 器 。 或 者 通过 变形 的 测量 ( 比如 光学 方式 ) 来 获 
得 ， 即 是 柔顺 传感器 。 如 果 乔 望 增加 被 动 柔 顺 ， 则 后 
面 一 种 方法 更 具 优势 。 


7.1.2. 从 间接 力 控制 到 力 /运动 混合 控制 


主动 交互 控制 策略 可 以 分 为 两 种 类 型 ， 间 接力 控 
制 和 直接 力 控制 。 两 种 类 型 之 间 的 主要 区 别 在 于 前 者 
没有 直接 的 力 反馈 回路 闭环 ， 通 过 运动 控制 来 实现 力 
控制 ;而 后 者 由 于 具有 力 反馈 回路 闭环 ， 使 控制 接触 
力 和 力矩 达到 一 个 期 望 的 值 成 为 可 能 。 

第 一 种 类 型 属于 阻抗 控制 (eA EI) UT, 
其 中 由 于 与 环境 相互 作用 会 导致 末端 执行 器 运动 对 于 
期 望 运动 产生 偏差 ， 这 种 偏差 被 认为 是 通过 带 可 调 参 
数 的 力学 阻抗 / 导 纳 而 与 接触 力 相 关 。 采 用 阻抗 (或 
导 纳 ) 控制 的 机 器 人 操作 手 可 以 使 用 一 个 具有 可 调 
参数 的 等 效 质量 - 弹簧 -阻尼 器 系统 来 描述 。 如 果 机 器 
人 控制 通过 产生 力 来 对 运动 偏差 作出 反应 ， 这 种 关系 
就 是 阻抗 。 而 如 果 机 器 人 控制 通过 施加 一 个 期 望 运 动 
的 偏差 来 对 相互 作用 力作 出 反应 ， 就 相当 于 导 纳 。 阻 
抗 控 制 和 导 纳 控制 的 特例 分 别 是 刚性 控制 和 柔顺 控 
制品 5 ， 这 里 只 考虑 了 未 端 执行 器 对 于 期 望 运 动 的 位 
置 和 姿态 偏差 与 接触 力 和 力矩 之 间 的 静态 关系 。 需 要 


在 主动 交互 控制 中 ， 机 器 人 系统 的 柔顺 主要 通过 
特意 设计 的 控制 系统 来 获得 。 这 种 方法 通常 需要 测量 
接触 力 和 力矩 ， 它 们 反馈 到 控制 器 中 用 于 修正 甚至 在 


注意 的 是 ， 在 机 器 人 控制 的 文献 中 ， 术 语 阻抗 控制 和 
导 纳 控制 常常 用 来 指 同一 控制 方案 ， 对 于 刚性 控制 和 
和 柔顺 控制 也 有 相同 的 情况 。 此 外 ， 如 果 仅仅 关心 接触 
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力 和 力矩 与 末端 执行 器 的 线 速 度 和 角速度 之 间 的 关 
系 ， 相 应 的 控制 方案 称 为 阻尼 控制 “”' 。 

一 般 而 言 ， 间 接力 控制 方案 不 需要 测量 接触 力 和 
力矩 ， 得 到 的 阻抗 或 导 纳 往往 是 非 线 性 和 耦合 的 。 但 
是 ， 如 果 有 力 / 力 失传 感 器 可 用 ， 把 力 测 量 值 用 于 控 
制 方案 中 就 能 得 到 线性 和 解 耦 的 情况 。 

与 间接 力 控 制 不 同 ， 直 接力 控制 需要 交互 作业 的 
显 式 模 型 。 事实 上 ,使 用 者 必须 相对 于 环境 所 施加 的 
约束 ， 按 一 致 的 方式 指定 期 望 的 运动 和 期 望 的 接触 力 
和 力矩 。 一 个 在 该 类 别 中 被 广泛 采用 的 策略 是 力 / 运 
动 混合 控制 ， 它 的 目的 在 于 沿 着 非 约束 的 作业 方向 控 
制 运动 和 沿 着 约束 的 作业 方向 控制 力 〈 和 力矩 ) h 
发 点 是 考虑 对 于 许多 机 器 人 作业 ， 引 入 称 为 柔顺 坐标 
系 ”" (或 作业 坐标 系 ” ) 的 正 交 参 考 坐 标 系 是 
可 行 的 ， 它 允许 以 沿 着 和 围绕 该 坐标 系 的 三 个 正 交 轴 
作用 的 自然 约束 和 人 为 约束 的 形式 来 指定 作业 任务 。 
基于 这 样 的 分 解 ， 力 /运动 混合 控制 允许 同时 在 两 个 
互相 独立 的 子 空间 中 控制 接触 力 和 末端 执行 器 的 运 
动 。 对 于 平面 接触 表面 "…” ， 作 用 于 期 望 量 和 反馈 量 
的 简单 选择 矩阵 可 用 来 满足 这 个 目标 。 然 而 ， 对 于 
般 的 接触 作业 ， 合 适 的 投影 矩阵 是 必须 使 用 的 ， 它 也 
可 以 由 显 式 约束 方程 得 到 ““' 。 可 以 提供 几 个 混合 
运动 控制 方案 的 实现 ， 比 如 在 操作 空间 的 基于 逆 动 力 
学 控制 路、 基于 无 源 性 的 控制 ”或 者 内 部 为 运动 
环 的 外 部 力 控制 环 ， 这 通常 用 在 工业 机 器 人 中 ”|。 

如 果 不 能 获得 精确 的 环境 模型 ， 力 控制 作用 和 运 
动 控制 作用 可 以 被 有 至 加 在 一 起 ， 得 到 的 就 是 并 行 力 / 
位 置 控制 方案 。 在 这 个 方法 中 ， 力 控制 器 被 设计 的 能 
够 支配 运动 控制 器 。 因 此 ， 为 了 确保 力 的 调整 ， 沿 着 


| 


为 简单 起 见 ， 只 考虑 非 元 余 非 奇异 机 械 手 的 情况 。 因 
Jt, n 26, 并 且 雅 可 比 矩 阵 是 一 个 非 奇 异 方 阵 。 末 端 
执行 器 作用 于 环境 的 力 f. 8171 4E. m. 是 力 螺旋 hh. = 
(fum.) 的 分 量 。 

有 必要 考虑 刚性 机 器 人 操作 手 在 与 环境 接触 情况 
下 的 操作 空间 动力 学 模型 公式 

A(q) v, «I(q,d)v,*n(q) =h, -h, (7.2) 
式 中 , Alq) = (JH(q) J)  &6 x6 操作 空间 惯性 
EE, Ta, q) -J C(q, q)J -ACq)JJI EE 
含 离心 力 和 科 氏 效应 的 力 螺 旋 , nq) J^ g(q) 是 
重力 效应 的 力 螺旋 , MW Hq). Clq, q) 和 g(g) 
是 在 关节 空间 里 所 定义 的 对 应 的 量 。 矢 量 h. =J TT 
是 与 输入 关节 力矩 T 对 应 的 等 效 末 端 执 行 器 力 螺 旋 。 
7.2.1 刚性 控制 

在 经 典 操作 空间 公式 中 ,末端 执行 器 的 位 置 和 姿 
ASH 6x1 的 矢量 x = (ple!) RHR, FA e, dé MA 
RR. 中 推算 出 的 一 组 欧 拉 角 。 因 此 ， 相 对 于 期 望 坐标 
系 刁 的 原点 的 位 置 p RUE EAR E R,， 末 端 执行 器 的 
期 望 位 置 和 姿态 可 以 用 一 个 矢量 x, 来 表示 。 末 端 执 
行 器 的 误差 可 记 为 Ar，=x, -x.， 在 假设 x, 为 常数 的 
情况 下 ， 对 应 的 速度 误差 可 表示 为 Arx，= -x = 
-AT (gp.)v,, 这 里 


I 
Ate =| 


eU 
0 Tg.) 
XB, 7 是 3 x3 单位 矩阵 ; 0 是 3 x 3 SM; TE 


关于 变换 e. =T(¢.) 9.13 x3 和 矩阵， 取决 于 欧 拉 角 


约束 的 作业 方向 的 位 置 误差 是 容许 的 ”| 。 


7.2 间接 力 控制 


为 了 深入 了 解 机 器 人 操作 手 的 末端 执行 器 与 环境 
之 间 相 互 作用 时 所 出 现 的 问题 ， 有 必要 分 析 在 存在 接 
触 力 和 力矩 情况 下 运动 控制 策略 的 效果 。 为 此 ， 假 设 
有 一 个 参考 坐标 系 丈 固 连 于 末端 执行 器 ， 并 将 原点 
的 位 置 撩 量 记 为 p,， 相 对 固定 基 坐 标 系 的 旋转 矩阵 
记 为 R.。 末 端 执行 占 的 速度 采用 6 x1 HRE v, = 
(pic) dm, Hb p ,是 平移 速度 ，w. 是 角速度 。 
该 速度 可 以 由 nx1 关节 速度 矢量 94 ， 利 用 如 下 线性 
变换 计算 得 到 


v, =J(g)g (7.1) 
AP, EEJ Æ 6 x n 的 末端 执行 器 几何 雅 可 比 和 矩阵。 


的 具体 选择 。 
考虑 在 操作 空间 简单 PD + 重力 补偿 控制 所 对 应 
的 运动 控制 律 
h.=A (e) KAx,. - Kyv, € n(q) 
sur, Ky Al Ks 是 对 称 正定 的 6x6 矩阵 。 
当 不 存在 与 环境 的 相互 作用 时 ( 即 当 有 ,=0 时 )， 
与 未 端 执行 需 期 望 位 置 与 姿态 对 应 ， 闭 环 系统 的 平衡 
v, =0、Axri. =0 是 渐 近 稳定 的 。 稳 定性 判 据 是 基于 正 
XE AREE KA 
Vs FvA (q)v, + Ft K Ax, 
它 沿 着 闭环 系统 轨迹 的 时 间 导 数 是 负 半 定 函 数 
V = -v'K,v, (7.4) 
TEP TE SÉ tt 7] DIE h OL T , ft IAS BY TEE RE 
夫 判 据 可 以 得 到 一 个 不 同 的 具有 非 零 Axu. 的 渐 近 稳 
定 平衡 。 这 个 新 的 平衡 是 下 面 方程 的 解 


(7.3) 
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A (e, ) K,Àx, —h, =0 


它 也 可 以 写成 如 下 形式 

Ax, -K; A (9p.)h, (7:5) 
或 者 等 价 地 写 为 

h, -A ' (e, ) K,Ax,, (7.6) 
式 (7.6) 表明 在 稳定 状态 下 ， 比 例 控制 作用 于 位 置 


和 姿态 误差 ， 末端 执 行 器 表现 得 像 一 个 关于 外 部 力 和 
力矩 AIS Ep E BE SEE, DRUG, AREE Ks 起 到 一 个 主 
动 刚性 的 作用 ， 这 意味 着 有 可 能 通过 调整 K, 的 元 素 
来 确保 末端 执行 器 在 交互 作用 过 程 中 具有 适当 的 弹性 
表现 。 类 似 地 ， 式 (7.5) 表示 一 种 柔顺 关系 ， 其 中 
和 矩阵 Kp 起 到 主动 柔顺 的 作用 。 这 种 方法 设 定期 望 位 
置 和 姿态 以 及 末端 执行 器 相对 期 望 运动 的 位 置 和 姿态 
户 差 与 施加 于 环境 的 力 之 间 的 适当 更 态 关 系 ， 被 称 为 
刚性 控制 。 
刚度 /柔顺 参数 的 选取 并 不 容易 ， 并 且 严 重地 依 
赖 于 所 执行 的 作业 。 主 动 刚 性 的 值 越 大 意味 着 较 高 的 
位 置 控制 精度 是 以 更 大 的 交互 作用 力 为 代价 的 。 因 
此 ， 如 果 希 望 在 个 别 方向 上 满足 一 些 物理 约束 ， 末 端 
执行 器 在 这 个 方向 上 的 刚度 就 要 表现 得 比较 低 以 确保 
较 小 的 交互 作用 力 。 反 之 ， 沿 着 没有 物理 约束 的 方 
向 ， 末 端 执行 器 的 刚度 则 应 该 表现 得 比较 高 以 便 精 确 
籽 跟 随 期 望 位 置 。 这 人 允许 不 用 过 大 的 接触 力 和 力矩 就 
能 解决 期 望 位 置 与 可 达到 的 位 置 之 间 的 偏差 ， 这 个 偏 
差 是 由 于 环境 所 施加 的 约束 导致 的 。 

但 是 ， 必 须 指 出 的 是 ， 在 基于 式 (7.6) 的 实际 
应 用 中 不 能 有 效 地 设 定 沿 着 不 同方 向 选择 的 刚度 特 
性 。 对 由 一 个 六 自由 度 弹 簧 所 连接 的 两 个 刚体 ， 从 以 
在 无 负荷 平衡 和 弹性 力 螺旋 两 种 情况 下 两 个 刚体 无 穷 
小 扭转 位 移 之 间 的 线性 变换 形式 表示 的 其 机 械 刚 度 的 
经 典 定义 来 看 ， 就 能 很 容易 地 理解 这 个 问题 了 。 

在 主动 刚性 情况 下 ， 这 两 个 刚体 分 别 是 固 连 有 
坐标 系 二 ,的 末端 执行 器 和 固 连 有 期 望 坐标 系 二 ,的 
虚拟 刚体 。 因 此 ， 在 如 下 定义 的 无 穷 小 扭转 位 移 情 


况 下 
ôr, = Mg n eu " (e 
90, Ac, c, 
Hist (7.6) 可 以 导出 如 下 的 变换 
h, =A" (@,) KpA~' (@, )8x,. 
式 中 ， AP a =P, -了 .是 位 置 误差 Api. = p, -Dp. 的 时 
间 导 数 ; Aw, = co, — w%. 是 角速度 误差 。 方程 (7.7) 
表明 实际 刚度 矩阵 是 4 p.) KA (e), EBURT 
由 矢量 ,表示 的 末端 执行 右 的 姿态 。 所 以 ， 在 实际 
应 用 中 选择 刚性 参数 是 非常 困难 的 。 


(7.7) 


这 个 问题 可 以 通过 定义 一 个 具有 与 理想 机 械 弹 得 
相同 的 结构 和 特性 的 几何 一 致 主动 刚性 来 解决 。 

1. 机 械 弹簧 

考虑 两 个 弹性 耦合 的 刚体 4 和 B， 以 及 分 别 固 连 
于 A 和 B 上 两 个 参考 坐标 系 MEX. BUY 
状态 时 坐标 系 了 ,和 允 , 是 重合 的 ,平衡 状态 附近 的 柔 
顺 特性 可 以 表示 为 线性 变换 


K, K, 
h; = Kôx D =| T ôx d 
K. K, 


式 中 ,及 是 在 坐标 系 B 中 表示 的 作用 于 刚体 8 的 弹 
性 力 螺旋 ， 出 现 于 坐标 系 二 ,相对 坐标 系 二 ,存在 一 个 
无 穷 小 扭转 位 移 ra, 的 情况 下 ， 该 位 移 也 是 在 坐标 系 
B 中 表示 的 。 由 于 ES 上 ,在 平衡 状态 时 是 重合 的 ， 
所 以 式 (7.8) 中 的 弹性 力 螺旋 和 无 穷 小 扭转 位 移 也 
AEREI PRR. MÆ, hy = VP 
dx), 28x. HEAR, XI TEH FANE A 上 的 弹性 力 螺 
We, 由 于 ôx = - 6x) A hè = K ôx = — hh, Z 
(7.8) 的 这 种 性 质 称 为 端 对 称 。 

在 式 (7.8) 中 , KÆ 6 x 6 对 称 正 半 定 刚度 矩 
KE, 3x23 和 矩阵 K 和 K, 分 别称 为 平移 刚度 和 旋转 刚 
度 ， 也 是 对 称 的 。 可 以 看 出 ， 如 果 称 为 耦合 刚度 的 
3 x3 抢 阵 天 .是 对 称 的 ， 旋 转 和 平移 之 间 有 最 大 程度 
HS, RAL, AAA DAD, 的 重合 原点 所 
对 应 的 点 称 为 刚度 中 心 。 对 于 柔顺 矩阵 也 有 类 似 的 定 
义 和 结 果 的 表达 式 。 尤 其 是 ， 在 柔顺 矩阵 C = 天 ”的 
非 对 角 块 是 对 称 的 情况 下 可 以 定义 柔顺 中 心 。 刚 度 中 
心 和 和 柔顺 中 心 不 一 定 是 重合 的 。 

这 里 有 一 些 平移 和 旋转 之 间 不 存在 耦合 的 特殊 情 
况 ， 比 如 ， 刚 体 的 相对 平移 引起 一 个 沿 一 个 过 刚度 中 
心 轴 的 纯 力 所 对 应 的 力 螺 旋 ， 还 有 刚体 的 相对 旋转 引 
起 一 个 等 价 于 绕 一 个 过 刚度 中 心 轴 的 纯 力 矩 的 力 螺 
旋 。 在 这 些 情况 中 ， 刚 度 中 心 和 柔顺 中 心 相 重合 。 具 
有 完全 解 耦 特性 的 机 械 系统 例子 有 比如 远 中 心 柔顺 
(RCC) 装置 。 

由 于 KK. 是 对 称 的 ， 在 平衡 状态 存在 相对 于 坐标 
A X, = D WIERE RE R, WIE K, = RIR', IFA 
TASA, HOM ATER eee RS TUE 
对 应 方向 上 的 主 平 移 刚度 ， 这 个 方向 称 为 平移 刚度 主 
轴 。 类 似 地 ，K, 可 以 表示 为 K, =RT R, Hob ru 
对 角 元 素 是 绕 旋转 矩阵 R, 的 列 所 对 应 轴 的 主 旋 转 刚 
度 ， 这 个 轴 称 为 旋转 刚度 主轴 。 此 外 ,假设 在 平衡 状 
S 了 ,和 ,的 原点 与 刚度 中 心 重合 ， 可 以 得 到 表达 式 
K. =R.T.R'， 其 中 工 的 对 角 元 素 是 沿 旋转 矩阵 R É 
列 所 对 应 方向 的 主 耦合 刚度 ， 这 个 方向 称 为 耦合 刚度 


(7.8) 
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主轴 。 总 而 言 之 ， 相 对 于 原点 为 刚度 中 心 的 坐标 系 ， 
6 x 6 的 刚度 和 矩阵 可 以 根据 主 刚度 参数 和 主轴 来 设 定 。 

要 注意 的 是 式 (7.8) 所 定义 的 机 械 刚 度 是 描述 
存储 势能 的 理想 六 自由 度 弹簧 的 特性 。 理 想 刚 度 的 势 
能 函数 仅仅 取决 于 连接 的 两 个 刚体 的 相对 位 置 和 姿 
态 ， 并 且 是 端 对 称 的 。 实 际 的 六 自由 度 弹 签 具有 与 理 
想 弹 簧 类 似 的 主要 特性 ， 但 仍然 总 是 具有 引起 能 量 
散 的 寄生 效应 。 

2. 几何 一 致 主动 刚度 

为 了 实现 几何 一 致 的 六 自由 度 主动 刚度 ， 需 要 在 
控制 律 式 (7.3) 中 适当 地 定义 比例 控制 作用 。 在 理 
想 坐 标 系 二 ,相对 末端 执行 器 坐标 系 二 ,存在 有 限 位 移 
的 情况 下 ， 这 个 控制 作用 可 以 表示 为 作用 在 末端 执行 
器 上 的 弹性 力 螺旋 。 因 此 ， 微 小 位 移 下 理想 机 械 刚度 
的 性 质 可 以 扩展 到 有 限 位 移 的 情况 。 此 外 ， 为 了 保证 
李 雅 普 庄 夫 意 义 上 的 渐 近 稳定 性 ， 必 须 定义 一 个 合适 
的 弹性 势能 函数 。 

简单 起 见 ， 假 设 耦 合 刚度 矩阵 为 零 。 因 此 ， 可 以 
求 和 平移 势能 和 旋转 势能 来 计算 弹性 势能 。 


平移 势能 可 以 用 
， 1 $1 è 
Kj, = S RKnR, * aR KR: 
定义 为 


Lj dea 
V, = FAP AK AP ic (7. 9) 


XP, KQZE3 x3 IPEE, ÆR (7.9) 中 使 
H K ACER K 保 证 势能 在 有 限 位 移 情况 下 也 是 端 对 称 
的 。 在 平衡 状态 (BIR, =R. 时 ) 和 具有 各 向 同性 平 
移 刚 度 ( 即 Ks =K EF) 的 情况 下 矩阵 天 0 和 Ki 是 
一 致 的 。 
计算 功 了 ,得 到 
V, Api fs + Aim, 

RP, Ap’ EME Api =R'(p, - p.) 的 时 间 导 
数 ; Ac -R.(c, €.) . "Ki fi Fl HELE FEE 
有 限 位 置 位 移 Ap'i. 情 况 下 作用 于 末端 执行 器 的 力 和 
力矩 。 当 在 基 坐 标 系 中 计算 时 ， 这 些 矢量 具有 如 下 表 
达 式 


fa =K p Ap,. My = Kp Ap,. (7. 10) 
这 里 
" 1 T 
Ky = EE Ap,. )R,K,,R; 


其 中 , S (+) 是 计算 矢量 积 的 反对 称 算 子 。 矢 量 
hy =(fy my) 是 在 存在 有 限 位 置 位 移 Ap, MENE 
转 位移 情 况 下 作用 在 未 端 执行 器 上 的 弹性 力 螺 旋 。 在 


具有 各 向 同性 平移 刚度 的 情况 下 力矩 ma Es 

要 定义 旋转 势能 ， 必 须 对 坐标 系 ,和 ,之 间 的 
姿态 位 移 采 用 一 个 适当 的 定义 。 一 个 可 能 的 选择 是 从 
ABE RS = R,R, 提 取得 到 的 单位 四 元 组 | ny, 65 
的 矢量 部 分 。 因 此 ， 姿 态势 能 具有 形式 

V,=2 eTK, ei. 

UP, K263 x3 对 称 正定 和 矩阵。 由 于 < 和 = - ef, 
所 以 函数 凡是 端 对 称 的 。 


计算 功 了 ,得 到 


LION 
其 中 

ma, - Kj, €x (7.12) 
这 里 


Ky, = 2E" (Naes E de )R.K,,R! 
FEHEM, Ex) -2m,I-S(C6,). WEAR A 
限 姿态 位 移 ej. =R! ei. 产生 一 个 与 纯 力 矩 等 效 的 弹 
性 力 螺 旋 h, = (0 ma,)'。 

因而 ， 在 期 望 坐标 系 ,相对 末端 执行 器 坐标 系 
忆 存 在 有 限 位 置 和 姿态 位 移 情 况 下 ， 整 个 弹性 力 螺 
旋 在 基 坐 标 系 中 可 定义 为 

h, =h, +hy, (7.13) 
其 中 ，j 和 hy, 分 别 按照 式 (7.10) MÈ (7.12) 
计算 。 

在 平衡 状态 附近 的 无 穷 小 扭转 位 移 6xi. 情 况 下 ， 
使 用 式 (7.13) 来 计算 弹性 力 螺 旋 ， 并 舍弃 高 阶 无 
穷 小 项 得 到 线性 变换 

K, 0 

h! = K,6x'. = x (7.14) 

e P de | 0 x} de 
因此 ，K, 表 示 理 想 弹 得 相对 于 原点 在 刚度 中 心 的 坐 
标 系 (平衡 状态 下 与 UEA) 的 刚度 矩阵 。 此 外 ， 
Hist (7.13) 的 定义 可 以 看 出 ， 在 大 位 移 情况 下 算 
阵 Ks 和 Kb, 的 主 刚度 和 主轴 的 物理 /几何 意义 仍然 保 
持 不 变 。 

上 述 结 果 意 味 着 对 于 当前 的 作业 ， 主 动 刚度 矩阵 
本 可 以 按 几 何 一 致 的 方式 来 设置 。 
注意 到 几何 一 致 性 也 可 以 由 对 式 (7.11) 姿态 
势能 中 姿态 误差 的 不 同 定 义 来 保证 。 例 如 ， 可 以 采用 
任何 基于 RI 的 角度 / 轴 表 示 的 误差 (单位 四 元 组 属于 
这 种 类 型 ) ， 或 者 更 一 般 地 ， 采 用 章 次 矩阵 或 指数 坐 
标 ( 对 于 具有 位 置 和 姿态 误差 的 情况 )。 而 且 ， 由 和 矩 
阵 Ri 提取 得 到 的 XYZ 欧 拉 角 也 可 以 使 用 。 但 是 ,在 
这 种 情况 下 可 以 看 出 旋转 刚度 的 主轴 不 能 任意 地 设 
置 ， 而 是 必须 与 末端 执行 器 坐标 系 的 轴 重 合 。 

采用 几何 一 致 主动 刚度 的 柔顺 控制 可 以 使 用 如 下 
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控制 律 来 定义 
h, =h, -Kyv, * n(q) 
这 里 使 用 的 是 式 (7.13) PA hao TE h, 20 时 平衡 
状态 的 渐 近 稳定 性 可 以 使 用 李 雅 普 诺 夫 函 数 来 证 明 
V2 TAG vt V+, 


这 里 的 V 和 ,分 别 是 在 式 (7.9) 和 式 (7.11) 中 给 
出 的 ， 在 坐标 系 ,静止 的 情况 下 ， 它 们 沿 着 闭环 系 
统 轨迹 的 时 间 导 数 具 有 与 式 (7.4) 中 一 样 的 表达 
式 。 当 有 .了 0 时 ， 对 应 于 期 望 坐标 系 也 ,相对 于 末端 
执行 器 坐标 系 也 的 非 零 位 移 ， 可 以 得 到 不 同 的 渐 近 
稳定 平衡 。 这 个 新 的 平衡 是 方程 h、 = 的 解 。 

通过 适当 选取 刚度 矩阵 ， 刚 度 控制 以 末端 执行 器 
的 位 置 和 姿态 误差 为 代价 ， 使 得 交互 作用 力 和 力矩 保 
持 在 有 限 范 围 内 而 不 需要 力 / 力 和 矩 传感器 。 但 是 ， 在 
出 现 能 够 建 模 为 等 效 末 端 执行 器 力 螺 旋 的 扰动 ( 比 
如 关节 摩擦 ) 的 情况 下 ， 采 用 值 比较 低 的 主动 刚度 
可 能 导致 相对 于 末端 执行 器 期 望 位 置 和 姿态 的 较 大 偏 
差 。 在 没有 与 环境 相互 作用 时 也 会 出 现 这 种 情况 。 


7.2.2 阻抗 控制 


刚度 控制 是 设计 来 实现 交互 作用 时 的 理想 静态 特 
性 的 。 事实 上 ， 控 制 系统 的 动态 特性 取决 于 机 器 人 操 
作 手 的 动态 特性 ， 而 它 是 非 线 性 和 耦合 的 。 一 个 要 求 
更 高 的 目标 可 能 是 实现 末端 执行 器 的 理想 动态 特性 。 
例如 ， 具 有 6 个 自由 度 的 二 阶 机 械 系统 的 动态 特性 ， 
可 以 用 给 定 的 质量 、 阻 尼 和 刚度 来 描述 ， 称 为 机 械 
阻抗 。 

要 实现 这 个 目标 的 出 发 点 可 能 是 用 于 运动 控制 
的 分 解 加 速度 方法 ， 它 的 目的 是 利用 逆 动 力学 控制 
律 在 加 速度 层次 上 对 非 线 性 的 机 器 人 动力 学 进行 解 
看 和 线性 化 。 存 在 与 环境 的 相互 作用 情况 下 ， 将 控 
制 律 


h, -A(q)a *I(q,q)4q +h, (7.15) 
代入 动力 学 模型 式 (7.2) 得 到 
v.-a (7.16) 


AF, a FE TEE BEA s AR BT BEE XC 38 24 


设计 的 控制 输入 。 考 虑 等 式 b, = 到 ?ie + Rv, 
这 里 


(7.17) 


得 到 
vi =a (7.18) 
式 中 ,控制 输入 a* 具 有 相对 于 末端 执行 器 坐标 系 的 


加 速度 的 意义 。 因 此 ， 设 定 


a Ky (vi +K Avi +h, -hi) | (7.19) 
对 于 闭环 系统 可 以 得 到 下 面 的 表达 式 
K Av‘, +K, Avi, +h =h (7.20) 


式 中 , Ky 和 K, 是 6 x 6 对 称 正定 和 矩阵，Av's. =v- 
vi; Av, -v; -v; vi Al vi^) NJ EIER AR f WY 
加 速度 和 速度 ; 后 是 弹性 力 螺 旋 。 这 里 所 有 的 量 都 
是 以 末端 执行 需 坐 标 系 忆 为 参考 的 。 

上 面 描述 受 控制 的 末端 执行 器 的 动态 特性 的 方程 
可 以 看 做 是 推广 的 机 械 阻 抗 。 在 hh. =0 时 的 平衡 状态 
的 渐 近 稳定 性 可 以 通过 考虑 李 雅 普 诺 夫 函 数 来 证 明 
(7.21) 


V= TM Ky Avi, +V, +V, 
XB, VA V DAE (7.9) 和 式 (7.11) 中 定 
义 ， 并 且 它 们 沿 系统 (7.20) 的 轨迹 的 时 间 导 数 是 
负 半 定 函 数 


V = Av "K Av’, 

X h AO 时 ， 对 应 于 期 望 坐标 系 马 相 对 于 末端 执行 
器 坐标 系 忆 的 非 零 位 移 ， 可 以 得 到 一 个 不 同 的 渐 近 
稳定 平衡 。 这 个 新 的 平衡 是 方程 hi = h WAR 

在 工 ,不 变 的 情况 下 ， 如 果 选 取 Ky 

Ee ^ 0 ) 
0 M 

st (7.20) 具有 真正 六 自由 度 机 械 阻 抗 的 意义 ， 其 
中 ,m 是 质量 ,，M 是 3 x3 EKE, K 被 选取 作为 
具有 3 x3 块 的 对 角 分 块 矩 阵 。 物 理 等 价 系统 是 质量 为 
m 的 刚体 ， 具 有 相对 于 固 连 在 刚体 上 的 坐标 系 了 的 惯 
性 张 量 M， 并 受到 外 部 力 螺 旋 有 的 作用 。 这 个 刚体 
通过 一 个 具有 刚度 矩阵 K, 的 六 自由 度 理 想 弹 得 与 一 
个 固 连 在 坐标 系 ,上 的 虚拟 刚体 相连 接 ， 还 受到 阻 
尼 为 本 的 黏 滞 力 和 力矩 的 作用 。 式 (7.21) 中 的 函 
数 了 表示 刚体 的 总 能 : 动能 和 弹性 势能 的 和 。 

图 7.1 简略 给 出 了 阻抗 控制 的 框图 。 阻 抗 控制 基 
于 位 置 和 姿态 反馈 以 及 力 和 力 抢 测量 ， 如 式 (7.17) 
和 式 (7.19) 中 那样 计算 加 速度 输入 。 然 后 ， 道 动 
力学 控制 律 利 用 式 (7.15) 中 的 hh 计算 关节 驱动 器 
fBr-J h.。 在 没有 交互 作用 情况 下 ， 这 个 控制 方 
案 保证 末端 执行 器 坐标 系 . 渐 近 地 跟随 期 望 坐 标 系 
Do TES MBER TROL PF, FEAR RASC (7.20) 对 
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末端 执行 器 施加 柔顺 动态 特性 ， 并 且 以 Xf YT 
有 限 的 位 置 和 姿态 位 移 为 代价 使 接触 力 螺旋 有 界 。 与 
刚性 控制 不 同 ， 用 于 测量 接触 力 和 力矩 的 力 / 力 和 矩 传 
感 顺 是 必需 的 。 


图 7.1 阻抗 控制 


1. 实现 问题 

选择 好 的 阻抗 参数 以 获得 令 人 满意 的 特性 并 不 是 
一 件 容易 的 任务 。 事 实 上 ， 闭环 系统 的 动态 特性 在 自 
由 空间 中 与 在 交互 作用 过 程 中 是 不 同 的 。 由 于 在 自由 
空间 中 必须 保证 运动 跟踪 和 扰动 抑制 ， 而 在 交互 作用 
过 程 中 主要 目标 是 实现 适当 的 末端 执行 器 柔顺 动态 特 
性 ， 它们 的 控制 目标 也 是 不 同 的 。 还 要 注意 在 交互 作 
用 中 控制 系统 的 动态 取决 于 环境 的 动态 。 

为 了 深入 理解 这 些 问题 ,假设 末端 执行 右 与 环境 
相互 作用 可 以 被 由 一 个 连接 末端 执行 器 坐标 系 5. 与 
环境 坐标 系 也 的 六 自由 度 理想 弹 钼 所 得 到 的 作用 来 
近似 。 由 此 ， 根 据 式 (7.8), 在 成 相对 三 存在 无 穷 
小 扭 位 移 的 情况 下 ， 末 端 执 行 器 作用 于 环境 的 弹性 力 
螺旋 可 以 计算 得 到 为 


h? = Kéx", (7.22) 
其 中 ， 在 平衡 状态 DA LAA, K 是 刚度 矩阵 。 
上 面 的 模型 仅 在 交互 作用 情况 下 成 立 ， 而 当 末 端 执行 
器 在 自由 空间 中 运动 时 接触 力 螺旋 为 零 。 

通过 在 机 器 人 操作 手动 态 模型 (7.2) 的 右 侧 引 
和 人 一 个 对 应 于 作用 在 末端 执行 器 上 的 等 效 扰动 力 螺旋 
的 附加 项 ， 可 以 把 作用 于 机 器 人 操作 手 的 扰动 和 未 建 
模 动态 (关节 摩擦 力 、 建 模 误 差 等 考虑 进去 。 这 
个 附加 项 在 式 (7.18) 的 右 侧 产生 一 个 附加 加 速度 
扰动 yx*。 因 此 ， 使 用 控制 律 式 (7. 19) ， 可 以 得 到 下 
面 的 闭环 阻抗 方程 

K Av‘, +K, Avi, +h, -hi +Kyy (7.23) 

阻抗 参数 的 整定 过 程 可 以 从 线性 化 的 模型 开始 ， 
在 无 穷 小 位 移 情 况 下 该 模型 可 以 由 式 (7.23) 计算 
得 到 ， 即 

Kx -Kj6x + (K, 4 K)óx,, = KO, + Ky" 
(7.24) 


这 里 使 用 了 式 (7.22) 和 等 式 Ox, = — Ox + dx’. 
上 面 的 方程 对 于 有 约束 (K40) 和 自由 运动 (K =0) 
都 是 成 立 的 。 

很 明显 ,适当 的 位 置 和 姿态 误差 动态 可 以 通过 
适当 地 选取 增益 矩阵 Ku, OK, 和 K RRE, EMA 
和 矩阵 都 是 对 角 阵 的 假设 下 ， 使 无 穷 小 扭转 位 移 的 六 
个 分 量具 有 解 耦 性 质 ， 这 个 任务 是 很 容易 的 。 在 这 
种 情况 下 ， 每 个 分 量 的 瞬 变 特性 可 以 通过 使 用 关 
系 式 


k, +k 1 ky 

m t Ua UU 
指定 固有 频率 和 阻尼 率 来 设 定 。 因 此 ， 如 果 选 取 的 
增益 在 相互 作用 ( 即 k 头 0) 过 程 中 确保 获得 给 定 的 
固有 频率 和 阻尼 率 ， 当 末端 执行 器 在 自由 空间 ( 即 
k=O) 中 运动 时 将 得 到 更 低 的 固有 频率 和 更 高 的 阻 
尼 率 。 至 于 稳 态 特性 ， 末 端 执行 器 一 般 分 量 的 误 
差 为 


k ky 
Ox, = (kp na d kp +k y 
并 且 相 应 的 交互 作用 力 为 
kpk kuk 
h= Nae ae 


上 述 关系 式 表明 ， 在 相互 作用 过 程 中 ， 只 要 相对 于 环 
境 刚度 左 设 定 低 的 主动 刚度 如 ， 以 大 的 稳 态 位 置 误差 
为 代价 就 可 以 使 接触 力 很 小 ， 反 之 亦 然 。 然 而 ， 接 触 
力 和 位 置 误差 又 都 取决 于 外 界 扰 动 y。 尤 其 是 ， 右 越 
低 ，y 对 6xj, 和 4 两 者 的 影响 越 大 。 此 外 ， 在 没有 交 
互 作用 情况 下 ( 即 k=0 HF) 低 的 主动 刚度 也 可 能 
导致 大 的 位 置 误差 。 

2. 导 纳 控制 

这 个 问题 的 解决 方法 可 以 按 下 面 把 运动 控制 从 
阻抗 控制 中 分 离 出 来 的 方式 来 构想 。 运 动 控制 作用 
等 意 设 定 为 刚性 以 便 增强 扰动 抑制 ， 来 确保 跟踪 由 
阻抗 控制 作用 得 到 参考 位 置 和 姿态 ， 而 不 是 保证 跟 
踪 末 端 执行 器 的 期 望 位 置 和 姿态 。 也 就 是 说 ， 期 望 
位 置 和 姿态 与 测量 的 接触 力 螺旋 一 起 输入 到 阻抗 方 
程 ， 通 过 适当 的 积分 产生 用 于 运动 控制 作为 参考 的 
位 置 和 姿态 。 

要 实现 这 个 解决 方法 ， 有 必要 引入 一 个 不 同 于 期 
望 坐标 系 马 的 参考 坐标 系 。 这 个 坐标 系 称 为 柔顺 坐 
ERES X. Hp. R, vo 和 v 所 确定 ， 这 些 量 由 
Pas Ry, vu FIL zi 以 及 测量 得 到 的 力 螺旋 及 通过 积分 
下 面 方程 计算 得 到 

K, Avi, +K Avi, +h) =h, 
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SUP, Ay ein AR LMA AY, ALE TE 
有 限 位 移 情 况 下 的 弹性 力 螺旋 。 这 样 ， 就 得 到 了 一 个 
基于 逆 动 力学 的 运动 控制 策略 ， 以 使 未 端 执行 器 坐标 
R 与 柔顺 坐标 系 LAA. WTR TASH 
稳定 性 ， 运 动 控制 器 的 带宽 应 该 高 于 阻抗 控制 器 的 


Pa, Ra 


Pe, R. 
: 位 置 和 姿 be 


图 7.2 给 出 了 所 设计 的 控制 方案 的 框图 。 很 明 
显 ， 在 没有 相互 作用 时 ， 和 柔顺 坐标 系 2.5 HER As 
Rx, 位 置 与 姿态 误差 动态 和 扰动 抑制 能 
力 仅 取决 于 内 部 运动 控制 环 的 增益 。 男 一 方面 ， 存 在 
交互 作用 的 情况 下 ,动态 特 性 受阻 抗 增益 (7. 25 ) 
的 作用 影响 。 


正和 运动 学 


图 7.2 带 有 内 部 运动 控制 环 的 阻抗 控制 ( 导 纳 控制 ) 


由 于 在 式 (7.25) 中 ， 给 定期 望 坐 标 系 的 运动 ， 
测量 的 力 (输入 ) 用 于 计算 柔顺 坐标 系 的 运动 ( 输 
出 ) ， 力 作为 输入 而 位 置 或 速度 作为 输出 的 变换 相当 
于 机 械 导 纳 ， 所 以 图 7.2 中 的 控制 方案 也 称 为 导 纳 控 
制 。 反之, 式 (7.20) 中 将 由 期 望 运动 轨迹 得 到 的 
末端 执行 需 位 移 (输入 ) 变换 到 接触 力 螺 旋 ( 输 
出 ) ， 则 具有 机 械 阻 抗 的 意义 。 

3. 简化 方案 

逆 动 力学 控制 是 基于 模型 的 ， 并 且 需 要 修改 当前 
工业 机 器 人 控制 器 ， 控 制 器 通常 配备 有 具有 很 高 带宽 
的 独立 PL 关节 速度 控制 器 。 如 果 环 境 足够 柔顺 ， 这 
些 控制 器 能 够 在 很 大 程度 上 解 耦 机 器 人 动力 学 ， 特 别 
是 在 慢 速 运动 情况 下 ， 来 减轻 外 部 作用 力 对 操作 手 的 
影响 。 因 此 ， 被 控制 机 器 人 的 闭环 动态 可 以 在 关节 空 
间 由 


4 = 4， 
来 近似 ， 或 者 在 操作 空间 等 价 为 
v, =v, (7.26) 


其 中 q, 和 vw, 是 由 适当 设计 的 外 控制 回路 所 产生 的 控 
制 信和 号， 用 于 内 部 速度 运动 控制 回路 。 这 些 控制 信号 
之 间 的 关系 为 


q.-J (q)v, 
对 应 于 分 解 速 度 控 制 ， 速 度 vw 可 以 按照 下 式 计算 
v! =) +Ky' (hy - ht) 
式 中 ,控制 输入 是 以 末端 执行 器 坐标 系 为 参考 的 ; 
K, 是 一 个 6 x6 正定 矩阵 ; h, 是 具有 刚度 矩阵 K, 的 弹 


性 力 螺旋 式 (7.13)。 这 样 ， 相 对 应 由 阻尼 Ks, 和 刚度 
了 所 摘 述 的 末端 执行 器 的 柔顺 特性 ， 得 到 闭环 方 
程 为 


K Avi, +h =h° 
Æ K, =O 情况 下 ， 得 到 的 方案 称 为 阻尼 控制 。 

作为 另 一 种 选择 ， 可 以 采用 导 纳 类 型 的 控制 方 
案 ， 这 里 柔顺 坐标 系 有. 的 运动 可 以 按照 位 置 p.、 姿 
AS R,. 和 速度 扭 撩 量 v. ， 以 微分 方程 

K, Avi, +h - ht 

的 解 来 计算 ， 其 中 的 输入 是 期 望 坐标 系 D, ie ws 
量 和 接触 力 螺旋 产 。 然 后 , .的 运动 变量 输入 到 内 部 
4 位 置 和 速度 控制 器 。 在 K =O 情况 下 ， 得 到 的 方 
案 称 为 柔顺 控制 。 


7.3 交互 作业 


尽管 要 达到 满意 的 动态 特性 ， 控 制 参数 必须 针对 
单独 的 作业 任务 进行 整定 ， 但 间接 力 控制 不 需要 明确 
的 环境 知识 。 另 一 方面 ， 对 于 直接 力 控制 算法 的 合 
成 ， 一 个 交互 作业 的 模型 是 必须 的 。 

交互 作业 是 由 操作 手 与 环境 之 间 复 杂 的 接触 状况 
来 描述 的 。 要 保证 作业 正确 地 执行 ， 对 相互 作用 力 和 
力矩 的 解析 描述 是 必要 的 ， 从 建 模 的 角度 来 看 这 是 非 
常 苛刻 的 要 求 。 

实际 的 接触 状况 是 一 种 自然 地 分 布 的 现象 ， 涉 及 
接触 表面 的 局 部 特性 以 及 操作 手 与 环境 的 全 局 动态 。 
具体 为 : 
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1) 由 于 一 个 或 多 个 不 同类 型 的 接触 ， 环 境 对 末 
端 执行 器 运动 施加 运动 学 约束 ， 并 且 当 末端 执行 器 趋 
向 于 违反 约束 时 会 产生 反作用 力 螺 旋 ， 例 如 ， 机 器 人 
使 刚性 工具 在 无 摩擦 刚性 表面 上 滑动 。 

2) 在 存在 环境 动态 情况 下 ， 当 未 端 执行 器 受到 
运动 学 约束 制约 时 ， 也 可 能 对 环境 施加 一 个 动态 力 螺 
Je, 例如， 机 器 人 转动 曲柄 ,与 曲柄 的 动态 是 有 关 
HJ, 或 者 机 器 人 推 挤 一 个 柔顺 表面 。 

3) 由 于 操作 手 的 关节 和 连 杆 ， 以 及 胸部 力 / 力 
和 矩 传感器 或 工具 的 有 限 刚度 ， 接 触 力 螺旋 可 能 取决 于 
机 器 人 结构 性 柔顺 ， 例 如 ， 安 装 在 RCC 装置 上 的 末 
端 执行 器 。 

4) 在 相互 作用 过 程 中 接触 表面 可 能 产生 局 部 变 
形 ， 从 而 产生 分 散 的 接触 区 域 ， 例 如 ， 工 具 或 环境 的 
软 接触 表面 的 情况 。 

5) 在 非 理 想 光 滑 接触 表面 情况 下 ， 可 能 产生 静 
摩擦 和 动 摩擦 。 

通常 在 简化 的 假设 下 进行 交互 控制 的 设计 和 性 能 
分 析 。 考 虑 下 面 两 种 情况 : 

1) 机 器 人 和 环境 都 是 完全 刚性 的 ， 环 境 所 施加 
的 仅仅 是 运动 学 约束 。 

2) 机 器 人 是 完全 刚性 的 ， 系 统 中 所 有 的 柔顺 局 限 
于 环境 中 ， 并 且 接 触 力 螺旋 可 以 由 线性 弹性 模型 近似 。 

在 这 两 种 情况 中 ， 都 是 假设 无 摩擦 接触 。 很 明显 
这 些 状况 都 只 是 理想 的 。 但是， 控制 的 鲁 棒 性 应 该 能 
够 处 理 一 些 对 理论 假设 放松 的 情况 。 在 那些 情况 下 ， 
控制 率 可 以 改变 以 适应 于 处 理 非 理 想 的 特性 。 


7.3.1 刚性 环境 


环境 所 施加 的 运动 学 约束 可 以 由 一 组 方程 表示 ， 
方程 的 变量 描述 必须 满足 的 末端 执行 器 位 置 和 姿态 。 
由 于 通过 正 运 动 学 方程 可 知 这 些 变量 由 关节 变量 确 
定 ， 因 此 约束 方程 也 可 以 在 关节 空间 表示 为 
pq) =0 (7.27) 
向 量 $ 是 m x1 的 函数 ， 有 是 m <n， 其 中 是 操作 手 
的 关节 数 ， 假 设 是 非 匈 余 的 。 不 是 一 般 性 ， 这 里 考虑 
n=6 的 情况 。 只 涉及 系统 广义 坐标 ， 形 如 (7.27) 
的 约束 称 为 完整 性 约束 。 形 如 gp(q，1) =0 的 时 变 约 
束 情况 这 里 不 考虑 ， 但 也 可 以 采用 类 似 的 方法 分 析 。 
此 外 ， 仅 仅 关注 形 如 (7.27) 等 式 所 表示 的 双 侧 约 
R; 这 意味 着 末端 执行 器 与 环境 一 直 保 持 接触 。 这 里 
给 出 的 分 析 称 为 动态 静 力 分 析 。 
假设 向 量 (7.27) 是 二 阶 可 微 ,并 且 它 的 m 个 
分 量 至 少 在 操作 点 的 邻 域 是 局 部 地 线性 无 关 的 。 因 
此 ,将 式 (7.27) 微分 ， 得 到 


m 


J,(q)q=0 (7.28) 
式 中 , Jy (gq) 20 /0q 是 $(g) UU m x6 雅 可 比 矩阵 ， 
称 为 约束 雅 可 比 。 根 据 以 上 假设 ， 至 少 局 部 地 在 操作 
点 的 邻 域内 J,(q) 的 秩 为 m. 
不 考虑 摩擦 的 情况 下 ， 广 义 相互 作用 力 由 趋 于 韦 
反 约 束 的 反作用 力 螺旋 来 表示 。 这 个 末端 执行 器 力 螺 
旋 在 关节 上 产生 的 反作用 力矩 可 以 使 用 虚 功 原理 计 
算 为 


T. =J(q)a 

式 中 , A dE mx1 的 拉 格 朗 日 乘 子 向 量 。 对 应 的 末端 
执行 器 力 螺 旋 可 以 计算 为 

h, =J (9q)T - S(q)A 


(7.29) 
其 中 

Si =J ' (q)J(q) (7.30) 
从 式 (7.29) 可 以 得 出 有 属于 由 6 x m FEM SE 
张 成 的 m 维 向 量 空间 。 线 性 变换 (7.29) 的 逆 为 


A-Si(q)h, (7.31) 
AF, Si RAN FER 5, 的 加 权 伪 逆 ， 即 
Si =(S'WS,) "SW (7.32) 


stb, Ws mpm e. 
注意 ， 尽 管 式 (7.30) 中 和 矩阵 5, 的 值 域 是 由 接 
触 的 几何 形状 唯一 定义 的 ， 矩阵 $, 自 身 却 不 是 叭 
的 ; 并 且 约 束 方程 (7.27) 、 相 应 的 雅 可 比 和 矩阵 J 和 
伪 首 Si， 以 及 向 量 和 也 不 是 唯一 定义 的 。 

通常 ， 对 的 元 素 测量 的 物理 单位 不 是 同类 的 ， 
矩阵 S, FUA PE Si 的 列 也 不 一 定 要 表示 同 质 的 实体 。 
这 可 能 在 变换 (7.31) 中 产生 不 变性 的 问题 。 如 果 
h 表示 一 个 受到 干扰 的 测量 的 力 螺旋 ， 作 为 结果 ， 可 
能 有 分 量 在 8, 的 值 域 范围 之 外 。 如 果 物 理 单位 或 参 
考 华 标 系 改变 了 ， 和 矩阵 5, 要 进行 变换 ;但 是 带 有 变 
换 的 伪 逆 的 式 (7.31) 的 结果 一 般 而 言 是 取决 于 所 
采用 的 物理 单位 或 取决 于 参考 坐标 系 。 原 因 在 于 伪 北 
ROET ttm, S, (4) A 的 范 数 的 最 小 化 问题 的 加 权 
最 小 二 乘 解 ， 并 且 只 有 使 用 这 个 向 量 的 物理 一 致 的 范 
数 才能 保证 不 变性 。 在 .在 S, 的 值 域内 的 理想 情况 
F, R (7.31) 中 的 A 有 唯一 解 ， 并 且 不 考虑 加 权 
和 矩阵， 这样 就 不 会 出 现 不 变性 的 问题 。 

一 个 可 能 的 解决 方法 在 于 选取 以 使 它 自 身 的 列表 
示 线 性 无 关 的 力 螺 旋 。 这 意味 着 式 (7.29) 使 玉成 
为 力 螺旋 的 线性 组 合 ， 并 且 A 是 无 量 纲 的 向 量 。 在 
力 螺 旋 空间 物理 一 致 的 范 数 可 以 基于 二 次 型 K-11. 
来 定义 ， 如 果 天 是 一 个 对 应 刚度 的 正定 和 矩阵， 其 具 
有 弹性 能 的 意义 。 因 此 ， 可 以 选取 W = K^ ou Dot 
的 加 权 和 矩阵 。 
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注意 ， 对 于 给 定 的 S$， 约 束 雅 可 比 可 以 由 式 
(7.30) HEH Jya) 2 S1J(q) ; 此 外 ， 可 以 通过 积 
4) (7.28) 得 到 约束 方程 。 

使 用 式 (7.1) 和 式 (7.30), 等 式 (7.28) 可 
以 重 写 形 为 


JDI (4)J(49) 4 =Siv,=0 (7.33) 
根据 式 (7.29) 的 假设 ， 其 等 价 于 
h'v, =0 (7.34) 


x (7.34) 表示 理想 反作用 力 螺 旋 (属于 所 谓 的 力 
控制 子 空 间 ) 和 服从 约束 的 末端 执行 器 扭 矢 〈 属 于 
所 谓 的 速度 控制 子 空间 ) 之 间 的 动态 静 力 关系 ， 称 
为 互 反 性 。 在 刚性 和 无 摩擦 接触 的 假设 条 件 下 ， 互 反 
性 的 概念 表达 这 样 的 物理 事实 ， 即 力 螺旋 克服 扭 拓 不 
做 任何 功 。 互 反 性 经 常会 与 正 交 性 的 概念 混淆 ， 由 于 
扭 矢 和 力 螺 旋 属 于 不 同 的 空间 ， 所 有 后 者 在 这 里 没有 
任何 意义 。 
式 (7.33) 和 式 (7.34) 意味 着 速度 控制 子 空 
间 是 m 维 力 控 制 子 空间 的 互 反 补 ， 由 和 矩阵 的 值 域 确 
定 。 因 此 ， 速 度 控制 子 空间 的 维 数 是 6 -m， 可 以 定 
义 一 个 6x (6-m) 的 和 矩阵 5S,， 它 的 列 张 成 速度 控 
制 子 空间 ， 即 


[rest 


v, -S.(q)v (7.35) 
SUP, v 是 适当 的 (6 -m) x1 的 向 量 。 由 式 (7.33) 


和 式 (7.35) 可 知 ， 下 面 的 等 式 成 立 
Si(gq)S,(q)=0 (7.36) 
此 外 ， 线 性 变换 (7.35) 的 逆 可 以 计算 为 
z=S (q)v, (7.37) 


x, S 表示 和 矩阵 S, Wi 4 Bg Aw, E 5x 
(7.32) 中 的 计算 一 样 。 
注意 , SS ATUL RE, SERRE S, E 
唯一 定义 的 ， 和 矩阵 $, 自 身 的 选取 却 不 是 唯一 的 。 此 
外 ，S, 的 列 也 不 一 定 要 是 扭 拓 ,标量 v 也 可 以 具有 不 
同 种 的 物理 量 纲 。 但 是 ， 为 了 避免 类 似 于 5 情况 中 
考虑 的 不 变性 问题 ， 可 以 简便 地 选择 $, 的 列 作为 扭 
矢 以 使 向 量 v 是 无 量 纲 的 。 此 外 , 式 (7.37) 中 用 于 
计算 伪 逆 的 加 权 和 矩阵 可 以 设 定 为 机 =M, 而 M 是 
6x6 的 惯性 矩阵 ， 这 相当 于 在 扭 矢 空间 基于 动能 定 
义 范 数 。 有 必要 注意 ， 对 应 参考 坐标 系 的 改变 ， 扭 矢 
和 力 螺旋 的 变换 和 矩阵 是 不 同 的 。 然 而 ， 如 果 扭 撩 定义 
为 角速度 在 上 平移 速度 在 下 ， 那 么 它们 的 变换 矩阵 和 
力 螺 旋 是 一 样 的 。 

矩阵 S, 也 有 使 用 雅 可 比 的 表达 形式 ， 与 式 
(7.30) 中 的 S, 一样。 由 于 存在 m 个 独立 几何 约束 
(7.27)， 可 以 用 一 个 为 独立 变量 的 (6 — m) x1 的 向 


r 来 描述 与 环境 接触 时 机 器 人 的 构 型 。 根 据 隐 函数 
: 理 ， 这 个 向 量 可 以 定义 为 

r=y(g) (7.38) 
SUP, plq) 是 任意 (6 -m) x1 的 二 阶 可 微 向 量 函 
数 ， 使 得 b(q) 的 mm 个 分 量 和 yw(q) n-m 个 分 量 
至 少 在 操作 点 的 邻 域 是 局 部 地 线性 无 关 的 。 这 意味 着 
映射 (7.38) 与 约束 (7.27) — ite Æ Je ip n] x m, 
CHEK 


BL om 


q -p(r) (7.39) 
RP, p(r) Æ 6x1 的 二 阶 可 微 向 量 函 数 。 方 程 
(7.39) 显 式 地 给 出 了 所 有 满足 约束 (7.27) 的 关节 
向 量 。 此 外 ， 满 足 式 (7.28) 的 关节 速度 向 量 可 以 
计算 为 

4 -J, (nr 
IP, J,(r) =dp/dr JE 6x (6- m) Big n] LEJE 
阵 。 所 以 ， 下 面 的 等 式 成 立 

J4(q)J,(r) =0 
'E "T EUE EE Ph ARI J 的 列 所 张 成 的 反作用 力矩 子 
空间 与 由 矩阵 J 的 列 所 张 成 的 带 约束 的 关节 速度 子 
空间 之 间 的 互 反 性 条 件 。 
重 写 上 面 的 方程 为 
Jaa) ICa) ICa), Cq) =0 

并 把 式 (7.30) 和 式 (7.36) 考虑 进去 ， 和 矩阵 S, aT 
以 表示 为 


S, 2J(q)J,(r) (7. 40) 
根据 式 (7.38) 和 式 (7.39) ， 可 以 等 价 地 表示 为 9 
或 了 的 函数 。 

AREE S 和 S. DL MITIS SiR SERA HE EE 
阵 。 它 们 除了 在 控制 综合 中 ， 在 作业 规范 中 也 起 着 重 
要 作用 ， 即 期 望 的 末端 执行 器 的 运动 和 相互 作用 力 与 
力矩 的 规范 。 


7.3.2 柔顺 环境 


在 很 多 应 用 中 ， 末 端 执行 器 与 柔顺 环境 之 间 的 相 
互 作用 力 螺旋 可 以 使 用 形 如 (7.22) 的 理想 弹性 模 
型 来 近似 。 但 是 ， 由 于 刚度 和 矩阵 K 是 正定 的 ， 当 环 
境 变形 与 末端 执行 器 无 穷 小 扭转 位 移 重 合 时 ， 这 个 模 
型 描述 的 是 完全 约束 的 情况 。 但 是 ， 一 般 来 说 末端 执 
行 器 的 运动 只 是 受到 环境 的 部 分 约束 ， 这 种 情况 可 以 
通过 引入 合适 的 半 正 定 刚度 矩阵 来 建 模 。 

可 以 通过 将 环境 建 模 为 一 对 刚体 S 和 0， 并 由 一 
个 柔顺 为 C=K” 的 理想 六 自由 度 弹 筑 连 接 ， 来 计算 
描述 末端 执行 器 与 环境 之 间 部 分 约束 的 相互 作用 的 刚 
BEBE. HR S 与 坐标 系 5, 固 连 ， 并 与 末端 执行 带 
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接触 ; 刚体 0 与 坐标 系 部 固 连 ， 这 个 坐标 系 在 平衡 
状态 与 坐标 系 下 重合 。 存 在 力 螺旋 及 的 情况 下 ， 环 
境 在 平衡 状态 附近 的 变形 可 以 由 坐标 系 AA YS B] 
的 无 穷 小 扭转 位 移 6xso 来 表示 ， 其 可 以 计算 为 

SX qo, = Ch, (7.41) 
为 了 简便 起 见 ， 后 面 所 有 参考 坐标 系 aE A E 
EF S. 

对 于 所 考虑 的 接触 状况 ， 因 为 环境 可 以 变形 ， 末 
端 执行 器 的 扭 矢 不 是 完全 属于 对 应 于 刚性 环境 的 理想 
速度 子 空 间 。 因 此 ,末端 执行 器 坐标 系 二 .相对 了 
的 无 穷 小 扭转 位 移 可 以 分 解 为 

Ôx 2Óx, + dx; (7.42) 
式 中 ，6x, 是 末端 执行 器 在 速度 控制 子 空间 的 无 穷 小 
扭转 位 移 ， 定 义 为 力 控制 子 空间 的 6 — m 维 互 反 补 ， 
而 xx; 则 是 对 应 于 环境 变形 的 末端 执行 器 的 无 穷 小 扭 
转 位 移 。 因 此 : 


uu 


ôx, =P ôx. (7.43) 

ox, = (I - P,)óx,, = (I - P,)óx,, (7. 44) 

式 中 , P, =S,S'1、S, 和 Si 是 与 在 刚性 环境 情况 下 一 样 

定义 的 。 和 矩阵 了 ,是 滤 除 所 有 不 在 $, 值 域内 的 末端 执 

行 器 的 扭 矢 (和 无 穷 小 扭转 位 移 ) 的 投影 矩阵 ， 而 

I-P, 是 滤 除 所 有 在 S, 值 域内 的 末端 执行 器 的 扭 矢 

(和 无 穷 小 扭转 位 移 ) 的 投影 矩阵 。 扭 和 撩 P,v 表示 自 
WEHR, MHR (I-P, )v 表示 约束 扭 撩 。 

在 无 摩擦 接触 假设 条 件 下 ， 和 刚性 环境 情况 下 一 
样 ， 末 端 执 行 器 与 环境 之 间 的 相互 作用 力 螺 旋 被 局 限 
TB EE $1 的 m 维 值 域 所 定义 的 力 控制 子 空间 
内 ， 即 


h.=SA=h. (7.45) 
式 中 , 和 A 是 mx1 的 无 量 纲 向 量 。 式 (7.42) 的 两 边 
都 左 乘 St， 并 利用 式 (7.41)、 式 (7.43), X 
(7.44) 和 式 (7.45) 得 到 
SI6r =STCSA 
这 里 利用 了 等 式 STP, =0。 因 此 ， 可 以 得 到 如 下 的 弹 
h, =S,A = K'óx,, (7.46) 
stip, K’=S,(S'CS,) | Si 是 半 正 定 的 刚度 矩阵 ， 对 
应 于 部 分 约束 的 交互 。 
如 果 采 用 柔顺 和 矩阵 C 作为 计算 S; 的 加 权 和 矩阵 ， 
则 K' 可 以 表示 为 


K'=P.K (7.47) 

SUP, P,=S,S} 是 滤 除 不 在 S, HEER A BS UCET A a AL 
TT AY JI EE HJ ES AB RE 

因为 用 于 部 分 约束 交互 的 柔顺 和 矩阵 的 秩 m «6, 


所 以 这 个 和 矩阵 不 能 计算 作为 K' 的 逆 。 但 是 ， 利 用 式 
(7.44)、 式 (7.41) 和 式 (7.45)， 可 以 得 到 下 面 的 
等 式 


dx, = C'h, 
其 中 和 矩阵 

C'=(1-P,)C (7.48) 
是 秩 为 6 -m 的 半 正 定 矩 了 泗 。 如 果 采 用 刚度 矩阵 K 作 
为 计算 $i 的 加 权 和 矩阵 ， 则 和 矩阵 C' 具 有 值得 注意 的 表 
达 式 C' ZC-S,(SIKS,) SL, 表明 C' 是 对 称 的 。 


7.3.3 作业 规范 


交互 作业 可 以 利用 期 望 的 末端 执行 器 力 螺旋 h, 
Al Rat 由 来 指定 。 为 了 与 约束 一 致 ， 这 些 向 量 必 
须 分 别 属于 力 控制 和 速度 控制 子 空间 。 这 可 以 通过 指 
定向 量 入 和 vw, 来 保证 ， 并 计算 hh 和 vw 为 

h,-SjÀ,, v, =S,r, 
式 中 ，S, 和 S, 必 须 在 作业 几何 的 基础 上 适当 地 定义 ， 
以 保证 考虑 到 选取 参考 坐标 系 和 改变 物理 单位 的 不 
变性 。 

很 多 机 器 人 作业 具有 一 组 正 交 参考 坐标 系 ， 在 这 
些 坐标 系 里 作业 规范 是 非常 容易 和 直观 的 。 这 样 的 坐 
标 系 称 为 作业 坐标 系 或 柔顺 坐标 系 。 交 互 作业 可 以 通 
过 设 定 沿 / 绕 着 每 个 坐标 系 轴 的 期 望 力 /力矩 或 期 望 
线 / 角 速度 来 指定 。 由 于 这 些 期 望 的 量 是 由 控制 右 所 
施加 ， 所 以 称 之 为 人 为 约束 ; 在 刚性 接触 情况 下 ， 这 
些 约束 是 那些 由 环境 施加 并 称 为 自然 约束 的 补充 。 
下 面 给 出 一 些 作业 坐标 系 定义 和 作业 规范 的 
例子 。 

1. 销 孔 装 配 

这 个 作业 的 目的 是 把 销 推 入 到 孔 中 ， 同 时 避免 析 紧 
和 卡 阻 现象 。 销 具有 两 个 运动 自由 度 ， 因 此 速度 控制 子 
空间 的 维 数 是 6 -m=2， 而 力 控制 子 空间 的 维 数 是 m = 
4。 作 业 坐 标 系 可 以 如 图 7. 3 中 所 示 那 样 选取 ， 并 通过 指 
定 下 面 的 期 望 力 和 力 抢 以 及 期 望 的 速度 来 完成 作业 


图 7.3 圆柱 销 插入 到 孔 中 
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1) 沿 着 x Ay MAD 
2) Sx My MMAR. 


期 望 速度 : 


1) 沿 着 za 轴 的 非 零 线 


作业 持续 直到 在 z, 方 


à 
XE 
be 


向 测量 到 很 大 的 反作用 力 ， 表 明 


销 已 经 磁 到 和 孔 的 底部 ， 这 在 图 中 没有 表示 出 来 。 因 
Jb, SERE $, 和 8$ .可 以 选取 为 


0 


oo O O O- m 
ooo Fe 


0 


0 


or CO CO 


0 0 


oor occ 
bm cc 


0 


式 中 ,5 的 列 具 有 力 螺旋 的 维 数 ，5, 的 列 具 有 扭 撩 的 


维 数 ， 如 作业 坐标 系 


末端 执行 器 ， 也 可 以 
2. 旋转 曲柄 


这 个 作业 的 目的 是 旋转 具有 自由 转动 手柄 的 昌 


手柄 具有 两 个 运动 自 日 


HE, xw 


柄 转轴 的 转动 。 因 此 速度 控制 子 空 


而 力 控 制 子 空间 的 维 


数 是 m =4。 


中 所 定义 的 。 
时 ， 它 们 相应 地 变换 。 作 业 坐 标 系 既 可 以 选择 固 连 于 


固 连 于 环境 。 


当 参 考 坐 标 系 改变 


柄 。 
绕 z 轴 的 转动 和 绕 曲 
间 的 维 数 是 6 -m =2, 
作业 坐标 系 可 以 如 


图 7.4 中 所 示 那 样 选取 ， 固 连 于 曲柄 。 


图 7.4 旋转 具有 空转 手柄 的 曲柄 


通过 指定 下 面 的 期 望 力 和 力矩 以 及 期 望 的 速度 来 


完成 作业 : 


1) 沿 着 x FH z HAH 


2) 绕 zx 轴 的 任意 


2) Sex FIL y MAI 7158 
期 望 速度 : 
1) 沿 着 y, 轴 的 非 零 线 速度 。 


速度。 


因此 ， 参 考 作 业 坐 标 系 ， 和 矩阵 SERI $, 可 以 选取 为 


D O OD O $T = 


EXPEDITE, EAA 


oo oF 0 2 


oor coo Oo 


0 
0 
0 
0 
1 
0 


oo e E a E = 
— D T O G a 


0 


标 系 相对 于 曲柄 是 固定 的 ， 


但 相对 于 末端 执行 器 坐标 系 〈 固 定 于 手柄 ) 和 机 


项 人 基 坐 标 系 都 是 运动 的 。 因 


此 ， 当 参考 末端 执 


行 妖 坐标 系 或 者 基 坐 标 系 时 ， 和 矩阵 SSH S. AB Ze Hh] 


变 的 。 


3. 在 平面 弹性 表面 上 滑动 方块 
这 个 作业 的 目的 是 在 平面 表面 上 沿 着 x, 轴 滑动 


一 个 方块 ， 同 时 用 一 个 作用 了 
力 推 它 。 物 体 具 有 3 个 运动 自由 度 ， 因 此 速度 控制 


F 弹性 平面 表面 的 给 定 


子 空 间 的 维 数 是 6 -m =3， 而 力 控 制 子 空间 的 维 数 
是 m=3。 作 业 坐 标 系 可 以 选取 固 连 于 环境 ， 如 图 


7.5 中 所 示 。 


图 7.5 在 平面 弹性 表面 上 滑动 块 状 物体 


通过 指定 期 望 速度 以 及 期 望 力 和 力矩 来 完成 


作业 : 


1) 沿 着 % 轴 的 非 零 速度 。 
2) 沿 着 y 轴 的 零 速度 。 
3) 绕 z 轴 的 零 角速度 。 


期 望 力 和 力矩 : 


1) 沿 着 zx 轴 的 非 零 力 。 
2) Z6 x, FI y FATE 
因此 ， 和 矩阵 SUIS, BY DER 


oo oro Oo 


0 


oro Oo 


0 


H D O O O 


0 


D occ om 
T O Gm c 
i 


0 0 


6 x 6 的 刚度 矩阵 天 ' 对 应 于 末端 执行 器 与 环境 之 间 部 
分 约束 的 相互 作用 ,除了 3 x3 主子 式 K', 的 元素 ， 
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K' 的 元 素 都 是 零 。 主 子 式 由 K' 的 第 3、4、5 行 和 第 
3、4、5 列 构成 ， 可 以 表示 为 


RP, c =c ,是 柔顺 矩阵 C 的 元 素 。 

4. 一 般 接触 模型 

对 于 各 种 实际 机 器 人 作业 的 规范 ， 作 业 坐标 系 的 
概念 被 证 明 是 非常 有 用 的 。 但 是 ， 它 只 适用 于 那些 复 
杂 度 有 限 的 作业 几何 ， 并 且 其 分 离 的 控制 模式 可 以 独 
立地 分 配 到 沿 着 单个 坐标 系 的 轴 的 3 个 纯 平移 和 3 个 
纯 转 动 方向 。 对 于 更 复杂 的 状况 ， 比 如 多 点 接触 的 情 
况 ， 作 业 坐 标 系 就 不 存在 了 ， 必 须 采 用 更 为 复杂 的 模 
型 。 一 个 合适 的 解决 方法 是 使 用 虚拟 接触 操作 手 模 
型 ， 其 中 使 用 一 个 被 操作 物体 与 环境 之 间 的 虚拟 运动 
学 链 来 建 模 每 个 单独 的 接触 ， 并 且 当 接触 时 赋予 被 操 
作物 体 (瞬时 地 ) 相同 的 运动 自由 度 。 所 有 单独 接 
触 的 虚拟 操作 手 形成 了 并 行 操作 手 ， 其 速度 和 力 运动 
学 方程 可 以 利用 真实 操作 手 的 标准 运动 学 方程 步骤 得 
到 ， 并 且 人 允许 构建 所 有 运动 约束 的 扭 矢 量 和 力 螺旋 空 
间 的 基 。 

一 个 更 为 一 般 的 方法 ， 称 为 基于 约束 的 作业 规 
范 。 它 开发 了 涉及 复杂 几何 和 /或 多 传感器 ( 力 / 力 
和 矩 、 距 离 、 视 觉 传感器 ) 的 使 用 的 新 应 用 ， 用 于 同 
时 控制 空间 中 的 不 同方 向 。 作 业 坐 标 系 的 概念 扩展 
到 多 个 特征 坐标 系 。 每 个 特征 坐标 系 可 以 使 用 沿 着 
坐标 系 轴 的 平移 和 转动 方向 来 对 作业 几何 的 一 部 分 
进行 建 模 ;约束 的 一 部 分 也 可 以 在 每 个 特征 坐标 系 
中 指定 。 通 过 合并 在 每 个 在 单独 特征 坐标 系 中 表示 
的 部 分 的 作业 和 约束 规范 ， 可 以 得 到 总 的 模型 和 总 
的 约束 集合 。 


7.3.4 基于 传感器 的 接触 模型 估计 


在 假设 精确 的 接触 模型 是 一 直 可 以 得 到 的 条 件 
下 ， 作 业 规 范 取决 于 对 速度 控制 子 空 间 和 力 控 制 子 空 
间 的 定义 。 另 一 方面 ， 在 大 多 数 实际 执行 中 ， 选 择 矩 
MESA $, 并 不 是 已 知 的 。 但 是 许多 交互 控制 策略 是 
相当 和 鲁 棒 的 ， 可 以 克服 建 模 误 差 。 事 实 上 ， 可 靠 地 处 
理 这 些 状 况 正 是 使 用 力 控制 的 原因 。 在 作业 执行 过 程 
中 ， 如 果 和 矩阵 S, 和 S, 可 以 使 用 运动 和 /或 力 测量 来 连 
续 更 新 ， 力 控制 器 的 鲁 棒 性 就 会 提高 。 

具体 来 说 ,假设 一 个 名 义 模型 是 可 以 得 到 的 。 当 
接触 状况 进展 不 同 于 模型 所 预测 的 那样 ， 测 量 的 运动 
和 力 开始 与 预测 的 偏离 。 这 些小 的 不 一 致 可 以 被 测量 


并 用 于 在 线 调整 模型 ， 所 使 用 的 算法 可 以 由 像 卡 尔 曼 
滤波 这 样 的 经 典 状态 - 空间 预测 - 校正 佑 计 得 到 。 

图 7.6 给 出 了 一 个 名 义 的 运动 和 力 变量 与 测量 的 
运动 和 力 变量 之 间 误 差 的 例子 ， 这 是 二 维 轮廓 跟踪 作 
业 的 典型 情况 。 如 果 环 境 不 是 平面 ， 接 触 法 向 的 姿态 
会 改变 。 因 此 ， 在 名 义 接触 法 向 和 实际 接触 法 向 之 间 
出 现 了 一 个 角度 误差 bg。 和 名义 接触 法 向 对 齐 到 作业 坐 
标 系 ( 轴 为 x, 和 y, 的 坐标 系 ) 的 % 轴 ， 而 实际 接触 法 
向 对 齐 到 实际 作业 坐标 系 ( 轴 为 ,和 y, 的 坐标 系 ) 
的 y 轴 。 这 个 角度 可 以 只 通过 速度 或 力 的 测量 
估计 。 


图 7.6 姿态 误差 的 估计 


a) 基于 速度 的 方法 b) 基于 力 的 方法 


1) 基于 速度 的 方法 : 实际 执行 的 线性 速度 v 与 
实际 轮廓 OOF SI x HH) 相 切 ， 而 不 是 完全 沿 着 x 
轴 ， 有 一 个 小 的 分 量 沿 着 y, 轴 。 于 是 姿态 误差 9 可 以 
由 0=tan ^! (v, /v,) 来 近似 。 

2) 基于 力 的 方法 : 测量 的 (理想 的 ) AJ S 
不 是 完全 沿 着 名 义 法 向 方向 对 齐 到 y 轴 ， 而 是 沿 着 x, 
轴 有 一 个 小 的 分 量 上。 于 是 姿态 误差 9 可 以 由 0 = 
tan" (f/f) 来 近似 。 

基于 速度 的 方法 会 受到 系统 机 械 柔 顺 的 干扰 ; 基 
于 力 的 方法 会 受到 接触 摩擦 的 干扰 。 


力 /运动 混合 控制 的 目的 是 将 对 末端 执行 需 运 动 
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和 接触 力 的 同时 控制 分 成 两 个 解 耦 的 单独 子 问题 。 在 
接 下 来 的 部 分 ， 对 刚性 环境 和 和 柔顺 环境 两 种 情况 ， 给 
出 了 混合 框架 下 的 主要 控制 方法 。 


7.4.1 分 解 加 速度 方法 


与 运动 控制 情况 一 样 ， 分 解 加 速度 方法 的 目的 是 
通过 逆 动 力学 控制 律 ， 在 加 速度 层次 对 非 线 性 的 机 器 
人 动力 学 进行 解 耘 和 线性 化 。 在 与 环境 存在 相互 作用 
的 情况 下 ， 寻 找 力 控制 子 空间 和 速度 控制 子 空间 之 间 
的 完全 解 耦 。 基 本 的 想法 是 设计 一 个 基于 模型 的 内 控 
制 环 来 补偿 机 器 人 操作 手 的 非 线 性 动态 以 及 解 耦 力 和 
速度 子 空间 ; 然后 设计 一 个 外 控制 环 来 保证 扰动 抑制 
和 未 端 执 行 器 期 望 力 与 运动 的 跟踪 。 

1. 刚性 环境 

对 于 刚性 环境 ， 外 部 力 螺 旋 可 以 写成 h. = S.A 的 


形式 。 通 过 求解 式 (7.2) 得 到 v, 并 将 其 代入 到 式 
(7.33) 的 后 一 个 等 式 的 时 间 导 数 中 ,可 以 从 式 
(7.2) 中 消去 力 乘 子 A。 这 样 可 以 得 到 


A=A,(q) ISTA (ph, -pu(g,9)] + STv,| 
(7.49) 
式 中 ， A,(q) -(SIA"S,) filu (q, d) =Tg + Wo 
因此 ， 约 束 动态 可 以 重 写 为 


A(q) v, * SjA (4) S'u, -P(q) [h, -pu(q,9)] 
(7. 50) 
式 中 , P=I-SA S A. 7, PS,=0, KIE G6 x6 
的 矩阵 了 是 滤 除 所 有 在 $, 的 值 域内 的 末端 执行 器 力 
螺旋 的 投影 矩阵 。 它 们 对 应 于 那些 趋 于 违反 约束 的 力 
螺旋 。 

式 (7.49) 说 明 力 乘 子 向 量 A. 也 瞬时 地 取决 于 
施加 的 输入 力 螺 旋 h,。 因 此 ， 通 过 适当 选取 hh,， 有 
可 能 直接 控制 那些 趋 于 违反 约束 的 力 螺 旋 的 m 个 独 
立 分 量 ; 这 些 分 量 可 以 利用 式 (7.29) 由 m SIR 
子 计算 得 到 。 男 一 方面 , 式 (7.50) 表示 的 一 组 6 
个 二 阶 微分 方程 ， 如 果 初 始 化 到 约束 上 ， 则 方程 的 解 
一 直 自 动 地 满足 式 (7. 27)。 

约束 系统 的 降 阶 动态 特性 可 由 6 — m 个 二 阶 方程 
描述 ， 这 些 方程 通过 在 式 (7.50) 两 边 都 左 乘 矩 阵 
Si 并 利用 


v.-S,r +Sp 
PONE v. 得 到 。 最 后 得 到 方程 为 


A,(4) » +8,A,(q) Stu, - S'[h, -up(q,9) -A(q) Sv] 
(7.51) 


这 里 利用 了 A, 2STAS, , 3X (7.36) 和 S'P=S,。 此 
外 ， 表 达 式 (7.49) 可 以 重 写 为 

A=A(g)SIA (D [h, -np(g,9) -A(g) Sv] 
这 里 利用 了 等 式 STS = -S'S.。 

通过 选取 控制 力 螺旋 有 如下， 可 以 设计 一 个 道 
动力 学 内 控制 环 

h, =A(q)S,@, +S, f, «p (q.d) +A(g) Sv 

(7.52) 


式 中 ，a, 和 及 是 适 当 设 计 的 控制 输入 。 
把 式 (7.52) 代入 到 式 (7.51) 和 式 (7.49) 
得 到 
» =a, 
A=f, 
表明 控制 律 (7.52) 能 使 力 控制 和 速度 控制 子 空间 
zt [RISE Ae TERIS 
值得 注意 的 是 ， 假 如 和 矩阵 S$, 和 5, 已 知 或 在 线 估 
计 ， 对 于 控制 律 (7.52) 的 执行 ， 定 义 用 于 约束 系 
统 的 构 型 变量 向 量 的 约束 (7.27) 和 (7.38) 是 不 
需要 的 。 在 这 些 情况 中 ,通过 用 向 量 AQQD) 指定 期 
A AA sty, (1) 指定 期 望 速度 ， 可 以 很 容易 地 
分 配 作业 任务 ; 而 且 ， 实 现 了 力 / 速 度 控 制 。 
WEJ AC) 可 以 通过 设 定 
f, 2A4Q0) (7.53) 
获得 ,但 是 由 于 它 不 包含 力 反 馈 ， 这样 选 取 对 干扰 力 
非常 敏感 。 另 外 可 以 替代 的 选取 为 
f=A(t) + Kí[ A4) - A(z) ] 


(7.54) 
或 者 
fy = A(t) KK [TA - A(D]dT. (7.55) 


式 中 ，K 和 K, 是 合适 的 正定 矩阵 增益 。 比 例 反馈 可 
以 减 小 干扰 力 导致 的 力 误差 ， 而 积分 作用 能 够 补偿 党 
量 扰动 偏差 。 
力 反馈 的 实现 需要 从 对 末端 执行 器 力 螺 旋 h, K 
测量 值 中 计算 力 乘 子 A， 这 可 以 利用 式 (7.31) 来 
得 到 。 

速度 控制 可 以 通过 下 面 的 设 定 来 得 到 


e, = v.) + K,[v,.(1) - v(t) ] 


1 (7.56) 
+ K,[ Dr.(0) - (2) Jat 


AF, K,, A K,, EA EAEE ak, AT A, 


对 于 任意 选取 的 正定 矩阵 Ky, AIK, , v.) Hr) 
的 渐 近 跟踪 都 保证 是 以 指数 收敛 的 。 
向 量 v 的 计算 可 以 利用 式 (7.31) 从 可 用 的 测 
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量 得 到 ， 其 中 利用 式 (7.1) 从 对 关节 位 置 和 速度 的 
测量 值 可 以 计算 出 末端 执行 器 的 扭 撩 。 

X (7.54) 或 式 (7.55) 与 式 (7.56) 表示 外 
控制 环 ， 它 保证 了 力 / 速 度 控制 和 扰动 抑制 。 

MG (7.27) MĂ (7.38) B n, 按照 式 
(7.30) 和 式 (7.40) 可 以 计算 出 矩阵 SH S,, JPA 
通过 指定 期 望 力 A (0). MHEMA ra) 可 以 设计 
出 力 / 位 置 控制 。 

力 控 制 可 以 像 上 面 那样 设计 ， 而 位 置 控制 可 以 通 


@,= r (0) *Ky[ ra) -v(t)] * Ky [ri G) -r(t) J 
FE), SPE ER aE BAY IE XE AR PE Ky, Ko, ri. 
r y(t) 和 r,G) 的 渐 近 跟踪 都 保证 是 以 指数 收敛 
的 。 利 用 式 (7.38) 从 关节 位 置 测量 值 可 以 计算 得 
到 位 置 反 馈 所 需要 的 向 量 r。 

2. 柔顺 环境 

在 柔顺 环境 情况 下 ， 按 照 对 末端 执行 器 位 移 的 分 
解 (7.42) ， 末 端 执 行 器 的 扭 矢 可 以 分 解 为 


v, - S» 4 C'SjÀ (7.57) 
式 中 ， 第 一 项 是 自由 扭 矢 ; 第 二 项 是 约束 扭 矢 ; 向 量 
v 与 式 (7.40) 中 的 定义 一 样 ; C' 在 式 (7.48) PE 
义 。 假 设 接触 几何 和 柔顺 是 不 变 的 ， 即 S, =0、C' = 
0 和 S, =0， 对 于 加 速度 也 有 类 似 的 分 解 成 立 
v, =S p +C'S,Aa (7.58) 

BT LRA Bi oh He R R (7.15)， 并 得 到 闭环 
(7.16)， 其 中 是 适当 设计 的 控制 输入 。 

考虑 到 加 速度 分 解 (7. 58) ， 选 取 
a=S æ, * C'S, f, (7.59) 
nf EA fii 7] PE i] PA xk BE dat ql rp fd. 3cER b, Y 
(7.58) 和 式 (7.59) 代入 到 式 (7.16). 中 ， 并 在 所 
得 到 的 方程 两 边 都 各 左 乘 一 次 Si 和 一 次 St ， 可 以 得 
到 下 面 解 耦 的 方程 


A sf, (7. 61) 

因此 ， 通 过 像 刚 性 环境 情况 那样 按照 式 (7.56) 选 
取 @,， 对 期 望 速度 v(t1) 和 加 速度 » (0). 的 渐 近 跟 
踪 都 是 以 指数 收敛 保证 的 。 控 制 输入 可 以 选取 为 
f= AGG) eR (Ag) AG) T+K, LA) -AC()] 
(7.62) 

对 于 任意 选取 的 正定 矩阵 KI K,、， 都 保证 期 望 力 
轨迹 AG, AG), Aa) 的 渐 近 跟踪 是 以 指 


(7. 60) 


数 收敛 的 。 
与 刚性 环境 情况 不 同 ， 对 于 力 控制 律 (7.62) 


的 实现 反馈 A 是 必需 的 。 这 个 量 可 以 由 末端 执行 器 
力 螺旋 的 测量 值 .计算 得 到 为 

A=Sth, 

然而 ， 由 于 力 螺 旋 的 测量 信号 往往 是 带 有 噪声 的 ， 反 
A 经 常会 替换 为 


À - SK I(q) d (7.63) 
其 中 关节 速度 是 采用 转速 计 测 量 或 对 关节 位 置 进 行 数 
值 微分 计算 得 到 的 ，K' 是 描述 部 分 约束 的 相互 作用 的 
半 正 定 刚度 和 矩阵 (7.47)。 对 于 式 (7.63) 的 计算 ， 
只 有 K' 的 知识 (或 估计 ) 是 必需 的 ， 并 不 需要 刚度 
EREK, FH, iE (7.59) 的 实现 也 是 需要 部 分 
约束 相互 作用 的 柔顺 矩阵 C' 的 知识 〈 或 估计 ) ， 而 不 
需要 完整 的 柔顺 和 矩阵 C。 
如 果 接 触 几 何 是 已 知 的 ， 但 只 有 环境 刚度 /柔顺 
的 估计 是 可 用 的 情况 下 ， 如 果 指 定 一 个 不 变 的 期 望 力 
Aa, EWE (7.59) 与 式 (7.62) 一 起 仍 可 以 保证 
力 误 差 的 收敛 。 对 于 这 种 情况 ， 控 制 律 (7.59) 具 
有 形式 


= 


= 


a=S,a,+ C'S, f 


st, C'=(1-P), C 是 柔顺 矩阵 的 一 个 估计 。 因 
此 , sb (7.60) 仍然 成 立 ， 而 作为 替代 式 (7.61), 
可 以 得 到 下 面 的 等 式 
A =L, f, 

stb, L, = (S°CS,) -181CS, 是 一 个 非 奇异 矩阵 。 因 
此 ， 力 控制 和 速度 控制 子 空间 仍 保持 解 而 ， 并 且 速 度 
控制 律 (7.56) 不 需要 修改 。 另 一 方面 ， 如 果 使 用 
st (7.63) 计算 A 的 时 间 导 数 作为 反馈 ， 只 能 得 到 


fiit Â. MER (7.63)、 式 (7.57) 和 式 (7.46), 
可 以 得 到 下 面 的 等 式 

和 -FA 
所 以 ， 使 用 常量 A TY A S 1 PET NS NI 


以 式 (7.62) 计算 力 控 制 律 信 ， 闭 环 系统 的 动力 学 
方程 为 


A «Kj, 大 天 人 = 大 天 A, 
表明 在 存在 不 确定 矩阵 五 情况 下 ， 通 过 适当 选取 增 
3$ Ky MILK, , t RT DUE UESE GRA A =A, 具有 指数 
渐 近 稳定 性 。 
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7.4.2 基于 无 源 性 的 方法 


基于 无 源 性 的 方法 利用 了 操作 手动 力学 模型 的 
无 源 特性 ， 其 对 于 有 约束 的 动力 学 模型 式 (7.2) 
也 是 成 立 的 。 很 容易 看 出 对 能 在 关节 空间 保证 矩阵 
H (q) -2C(q, 7) 的 反对 称 性 的 矩阵 CCg，7 ) 的 
选取 ， 也 会 使 矩阵 A(g) -20(q, 4) 为 反对 称 。 这 
是 在 无 源 性 控制 算法 基础 上 的 拉 格 朗 日 系统 基本 
特性 。 

1. 刚性 环境 

控制 力 螺旋 有 可 以 选取 为 

h, -A(q)S,v, «I (q,0)v, * (S)! 
K,(v, -v) *9(q) +S f, 


(7.64) 


sth, P'(q, q) = IS, + AS ; K, 是 合适 的 对 称 正 
EERE, v 和 有 人 是 适当 设计 的 控制 输入 。 
把 式 (7.64) 代入 式 (7.2) 中 得 到 
A(q4)8,$, +D (q, q)s, + (S) K,s, - S(f, -A) =0 
(7. 65) 


其 中 y, =z,-z 和 8 =zw -r», RHAI AAAA E] 
非 线性 和 耦合 。 

X (7.65) 两 边 都 左 乘 矩 阵 8,， 可 以 得 到 下 面 
的 降 阶 动力 学 表达 式 

A,(q) 5, +1\(4,q)s, +K,s, =0 


(7. 66) 


其 中 工 =S?T(g,， 4 )S,+S'A(gq)5S,。 可 以 很 容易 看 
出 矩阵 A (4) -2T(gq，g ) 的 反对 称 性 意味 着 矩阵 
A,(q) -20.(q, 4) 也 是 反对 称 的 。 

另 一 方面 ， 将 式 (7.65) 两 边 都 左 乘 矩阵 STA^' (q), 
可 以 得 到 下 面 的 力 动 态 表 达 式 
f, -A= -A,(q)St + A^ QOL (4,4) + CST)" K,]s, 

(7. 67) 

表明 力 乘 子 A 瞬时 地 取决 于 控制 输入 fA， 但 也 在 速 
度 控 制 子 空间 取决 于 误差 s, 。 

按 以 下 选取 ， 可 以 保证 降 阶 系统 (7.66) 的 渐 
近 稳 定性 


(7. 68) 
(7. 69) 


v, =v; +æAv 


v, =V; tax, 


RH, a 是 正 增益 ; v ,和 vw 分 别 是 期 望 加 速度 和 速 
E; Av=v,-v, IK Ax, = [ woar, 


稳定 性 判 据 基 于 正定 李 雅 普 诺 夫 函 数 


V= Ts1A, (q)s, +@Ax'K, Ax, 


沿 着 式 (7.66) 的 轨迹 ， 其 时 间 导 数 为 
V = - Av'K, Av - a? Ax! K, Ax, 

是 一 个 半 负 定 函 数 。 因 此 ， 渐 近 地 As-0, Ax, =0 
Alls, =0。 所 以 , 保证 了 对 期 望 速度 v(t1) 的 跟踪 。 
WA, st (7.67) 的 右 侧 保持 有 界 并 逐渐 为 零 。 所 
以 ， 按 照 式 (7.53) 、 式 (7.54) 或 式 (7.55) 的 选 
取 ， 通 过 像 分 解 加 速度 方法 中 那样 设 定 凡 ， 就 可 以 
保证 对 期 望 力 A CI). 的 跟踪 。 
注意 ， 假 如 按照 式 (7.30) 和 式 (7.40) 来 计 
FERE S A $.， 并 且 在 式 (7.68) 和 式 (7.69) 中 
使 用 向 量 >， = rm 、z = 了, 和 Ax, r-r, WRR 
(7.38) 中 的 向 量 > 指 定 为 期 望 位 置 六 (5) ， 可 以 得 到 
位 置 控制 。 

2. 柔顺 环境 

控制 力 螺旋 有 .可 以 选取 为 


h, - A(q) v, « T(q, 9 v +K (vw) +h, *3(q) 
(7.70) 
式 中 ,及 是 合适 的 对 称 正定 和 矩阵， 而立 及 其 时 间 导 


数 w, 则 选取 为 


v, =V; + &Ax 

v, = v, t+aAv 
式 中 , a 是 正 增益 ; 四 及 其 时 间 导 数 vei hie 
计 的 控制 输入 ，Av=v -wv， 并 且 Ax = | Avat, 


把 式 (7.70) RAR (7.2) 中 得 到 
A(q)s +T(g,g)s+Kss=0 


(7.71) 
Hp s =v, -v Ñls=v, -v 

通过 以 下 设 定 ， 可 以 保证 系统 (7.71) 的 渐 近 
稳定 性 : 


v, -Sv, +C'S,A, 
式 中 , vj (1) 是 期 望 速度 轨迹 ; A, (1) 是 期 望 力 轨 
迹 。 稳 定性 判 据 基 于 正定 李 雅 普 诺 夫 也 数 


V= STA (q)s +@Ax'K, Ax 


沿 着 式 (7.71) 的 轨迹 ， 其 时 间 导 数 为 ， 

V = - Av K,Av - a! Ax' K,Ax 
是 一 个 负 定 函 数 。 因 此 , 渐 近 地 Av 20 Fl Ax 20, 在 
接触 几何 和 刚度 不 变 的 情况 下 ,下面 的 等 式 成 立 
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Av - S, (v, -v) +C'S,(A, - A) 


Ax = S, [ (v, -v)dt + C'S,(A, - A) 


表明 属于 互 反 子 空间 的 速度 和 力 跟 踪 误 差 ， 都 渐 近 地 
收敛 到 零 。 


7.4.3 分 解 速度 方法 


分 解 加 速度 方法 以 及 基于 无 源 性 的 方法 都 需要 改 
造 现 有 工业 机 器 人 控制 器 。 像 阻抗 控制 那样 ， 如 果 接 
触 足够 柔顺 ， 运 动 控制 的 机 器 人 闭环 动态 可 以 由 对 应 
于 速度 分 解 控制 的 式 (7.26) 近似 。 

按照 未 端 执行 器 扭 矢 分 解 〈7.57) ， 要 实现 力 和 
速度 控制 ， 控 制 输 入 vw, 可 以 选取 为 

v, - S v, +C'S 人 


(7.72) 
其 中 
v, r0) +K,[ e -elat (7.73) 

以 及 

AAG) tKa lA) -AQ)] (7.74) 
式 中 ， 玉 ,和 天 ,是 合适 的 对 称 正定 矩阵 增益 。 速 度 控 
制 和 力 控制 子 空间 之 间 的 解 粗 ， 以 及 闭环 系统 的 指数 
渐 近 稳定 性 可 以 像 分 解 加 速度 方法 中 一 样 证 明 。 而 
且 ， 由 于 力 误 差 具 有 二 阶 动态 ， 可 以 在 式 (7.74) 
上 增加 一 个 积分 作用 来 提高 扰动 抑制 能 力 ， 即 

f = A, (t) + Ky LACE) - A(t) ] 


+ Ka f TA. - ACO Jat 


(7.75) 


并 且 如 果 和 矩阵 Ka 和 Ky eT EE AY, AT PRET 
数 渐 近 稳定 性 。 
与 分 解 加 速度 方法 中 一 样 ， 如 果 在 式 (7.72) 


中 使 用 环境 刚度 矩阵 的 估计 C， 对 于 式 (7.74) 
和 式 (7.75) 仍然 还 能 保证 和 指数 收敛 到 常 
BA, 

在 有 些 应 用 中 ， 除 了 刚度 矩阵 ， 环 境 几 何 也 是 不 
确定 的 。 在 这 些 情况 中 ， 可 以 不 使 用 选择 矩阵 S n 
5, 把 力 控制 子 空间 从 速度 控制 子 空间 中 分 离 出 来 ， 就 
能 实现 类 似 式 (7.72) 的 力 /运动 控制 律 。 使 用 完整 
速度 反馈 ， 运 动 控制 律 可 以 设 定 为 式 (7.73). 。 同 
样 ， 使 用 完整 的 力 和 运动 反馈 ， 力 控制 律 可 以 设 定 为 
X (7.75) 。 也 就 是 说 ， 在 六 维 (6-D) 空间 的 所 有 
方向 上 都 既 施 加 了 运动 控制 又 施加 了 力 控制 。 所 得 到 
的 控制 ， 称 为 带 运动 前 馈 的 力 控制 或 力 /位 置 并 行 控 
制 。 由 于 存在 力 误差 的 积分 作用 ， 保 证 了 力 控制 相对 


位 置 控制 的 主导 地 位 。 进 而 ， 以 沿 有 约束 作业 方向 的 
位 置 误差 为 代价 保证 了 力 的 调节 。 


7.5 结论 与 扩展 阅读 


本 章 从 一 个 统一 的 角度 概述 了 力 控制 的 主要 方 
法 。 但 是 ， 还 是 有 许多 没有 考虑 到 的 方面 ， 在 处 理 
交互 的 机 吉 人 作业 时 必须 把 它们 仔细 地 考虑 进去 。 
力 控 制 的 两 种 主要 模式 (阻抗 控制 和 力 / 运 动 混合 
控制 ) 是 基于 几 个 简化 假设 的 ， 它 们 在 实际 执行 中 
仅仅 部 分 地 满足 。 事 实 上 ， 力 控制 的 机 器 人 系统 的 
性 能 取决 于 同 变化 的 环境 之 间 的 相互 作用 ， 这 种 变 
化 的 环境 是 非常 难以 建 模 和 正确 辩 识 的 。 不 仅 在 定 
量 上 而 且 在 定性 上 ， 一般 的 接触 状况 远 不 是 可 以 完 
全 预测 的 : 接触 构 型 可 能 突然 地 改变 , 或 者 是 不 同 
于 预期 的 类 型 。 因 此 ， 用 于 评价 一 个 控制 系统 的 标 
准 性 能 指标 ， 比 如 稳定 性 、 带 宽 、 精 度 和 重 棒 性 ， 
就 不 能 像 机 器 人 运动 控制 那样 只 考虑 机 器 人 系统 来 
定义 ， 而 必须 一 直 参 考 当时 特别 的 接触 状况 。 而 且 ， 
对 所 有 这 些 不 同 状 况 进行 分 类 也 是 不 容易 的 ， 尤 其 
是 在 动态 环境 情况 下 和 涉及 并 行 施加 的 多 个 接触 的 
作业 任务 。 
由 于 力 控 制 问题 回 有 的 复杂 性 ， 在 过 去 的 三 十 年 
中 有 大 量 关 于 这 个 主题 的 研究 论文 发 表 。 参 考 文献 
[7.20] 提供 了 对 第 一 个 十 年 的 发 展现 状 的 描述 ， 而 
第 二 个 十 年 的 进展 则 在 参考 文献 [7.21] 和 参考 文 
献 [7.22] 中 作 了 概述 。 最 近 ， 出 版 了 两 部 关于 力 
控制 的 专著 参考 文献 【7.23，24] 。 在 下 文中 提供 了 
参考 文献 列表 ， 本 章 所 给 出 推导 的 更 多 细节 以 及 这 里 
没有 覆盖 到 的 主题 都 能 在 里 面 找到 。 


间接 力 控制 


用 于 关节 坐标 系 下 的 力 控制 的 广义 弹簧 和 阻尼 的 
概念 最 初 是 在 参考 文献 [7.3] 中 提出 的 ， 并 在 参考 
文献 [7.10] 中 讨论 了 实现 问题 。 参 考 文献 [7.9] 
则 提出 了 第 卡 儿 坐 标 系 下 的 刚性 控制 。 参考 文献 
[7.25] 中 讨论 了 成 功 进行 刚性 零件 装配 的 基于 远 中 
心 柔 顺 的 装置 。 参 考 文献 [7.7] 提出 了 机 械 阻抗 模 
型 的 最 初 想法 ， 用 于 控制 操作 手 和 环境 之 间 的 相互 作 
用 ， 并 在 参考 文献 [7.8] 中 给 出 了 类 似 的 公式 。 参 
考 文 献 [7.26] 分 析 了 阻抗 控制 的 稳定 性 ， 并 在 参 
考 文献 [7.27] 中 考虑 了 与 刚性 环境 的 相互 作用 
问题 。 

为 克服 机 器 人 操作 手动 态 参数 的 不 确定 性 ， 提 出 


7.5.1 
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了 自 适 应 阻抗 控制 算法 ”32 ， 而 在 参考 文献 
[7.30] 中 则 给 出 了 重 棒 控制 方案 。 阻 抗 控 制 还 曾 用 
于 力 /运动 混合 控制 框架 中 

参考 文献 [7. 32] 是 一 个 关于 六 自由 度 

的 ) 刚度 建 模 的 参考 工作 ， 而 在 参考 文献 [7. 33- 
35] 中 则 详细 地 分 析 了 空间 柔顺 的 特性 ; 参考 文献 
[7.36] 给 出 一 个 六 自由 度 可 变 柔 顺手 腕 ， 同 时 参考 
文献 [7.37, 38] 给 出 一 些 关于 构建 为 特定 作业 优 
化 的 可 编程 柔顺 的 研究 。 参 考 文献 [7.39] 介绍 了 
利用 旋转 矩阵 导出 空间 柔顺 的 基于 能 的 方法 ; 基于 对 
末端 执行 器 姿态 的 不 同 表示 形式 ， 包 括 单位 四 元 组 在 
内 ， 各 种 六 自由 度 阻 抗 控制 方案 在 参考 文献 【7. 40] 
中 都 能 找到 。 在 参考 文献 【7.41] 中 基于 四 元 组 的 
公式 被 推广 到 非 对 角 分 块 刚 度 矩 阵 的 情况 。 在 无 源 性 


处 理 了 。 在 参考 文献 [7.18, 54, 55] 中 针对 自 适 
应 控制 和 在 参考 文献 [7.56] 中 针对 和 鲁 棒 控制 ， 实 
现 了 从 无 约束 运动 控制 到 有 约束 情况 下 基于 模型 的 
方案 的 变换 。 

由 于 对 于 力 误 差 施加 积分 作用 ， 力 控制 相对 运动 
控制 占 主导 地 位 。 基 于 这 样 的 观念 ， 为 处 理 环 境 几 何 
不 确定 性 设计 的 方法 有 采用 前 馈 运 动 方案 的 力 控 
al?) SRT ee Pe a”! 。 在 参考 文献 【7. 37] 
中 开发 了 一 个 并 行 力 / 位 置 校准 器 。 积 分 作用 来 消除 
稳 态 力 误差 是 传统 的 用 法 ; 其 稳定 性 在 参考 文献 
[7.57] 中 得 到 证 明 ， 同 时 参考 文献 [7.59, 60] 对 
关于 力 测 量 时 延 的 鲁 棒 性 进行 了 研究 。 

在 与 环境 接触 过 程 中 力 控 制 可 能 引起 不 稳定 表 
已 经 被 普遍 地 意识 到 了 。 在 参考 文献 [7.61] 中 


框架 下 对 空间 阻抗 控制 的 一 个 严密 的 处 理 可 见于 参考 
文献 [7.42], 


7.5.2 作业 规范 


参考 文献 [7. 11] 中 介绍 了 自然 和 人 为 约束 以 
及 柔顺 坐标 系 的 概念 。 在 作业 坐标 系 形 式 体 系 下 ， 
参考 文献 [7.12, 43] 系统 地 发 展 了 这 些 想法 。 参 
考 文献 [7.44, 45] 讨论 了 关于 广义 力 和 速度 方向 
的 互 反 性 的 理论 问题 ， 同 时 在 参考 文献 [7.46] 中 
论述 了 机 器 人 学 中 广义 逆 的 计算 中 的 不 变性 。 参 考 
文献 [7.47] 中 考虑 了 部 分 约束 作业 的 问题 ， 建 立 
了 半 正 定 刚 度 和 柔顺 和 矩阵 模型 。 在 参考 文献 
[7.48, 49] 中 考虑 了 几何 不 确定 性 的 估计 问题 ， 
以 及 基于 约束 的 作业 规范 与 实时 作业 执行 控制 的 连 
接 问题 。 这 个 方法 在 参考 文献 [7.50] 中 得 到 推 
广 ， 提 出 了 一 种 用 于 指定 复杂 作业 的 基于 约束 的 系 
统 方法 。 


7.5.3 力 / 运 动 混 合 控制 


关于 力 控 制 的 早期 研究 可 见于 参考 文献 
[7.10]。 基 于 自然 和 人 为 约束 作业 的 公式 表示 中， 
参考 文献 [7.13] 介绍 了 最 初 的 力 /位 置 混合 控制 的 
概念 。 在 参考 文献 [7.17] 中 给 出 了 对 操作 手动 态 
模型 的 显示 包含 ， 而 在 参考 文献 【7.51] 中 开发 了 
一 种 对 与 动态 环境 相互 作用 建 模 的 系统 方法 。 采 用 逆 
动力 学 控制 器 的 有 约束 公式 表示 在 笛 卡 儿 空 
Jg] DR EXE ZR IUS 进行 了 论述 。 与 基于 
线性 化 方程 的 控制 器 一 起 ， 在 参考 文献 [7.16] 中 
也 使 用 了 有 约束 的 方法 。 在 参考 文献 [7.45] 中 所 
指出 的 不 变性 问题 在 其 他 的 论文 451 中 被 正确 地 


1 


绍 了 解释 这 个 现象 的 动态 模型 ， 而 实验 研究 可 见于 
考 文献 [7.62] 和 [7.63]。 此 外 ， 控 制 方案 通常 
在 操作 手 末 端 执 行 器 正在 与 环境 接触 并 且 这 个 接触 
会 失去 的 假设 下 得 到 的 。 冲 击 现象 可 能 会 出 现 并 应 该 
得 到 仔细 的 考虑 ， 而 且 对 控制 方案 的 整体 分 析 也 是 需 
要 的 ， 包括 从 非 接 触 到 接触 状况 的 转变 ， 反 之 亦 然 ， 
DEKE 。 
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机 费 人 体系 结构 与 程序 设计 


David Kortenkamp, Reid Simmons 


刘海 波 


机 如 人 软件 系统 日 趋 复 杂 ， 这 种 复杂 性 主要 源 
自 种 类 繁多 的 传 感 呆 和 执行 器 的 实时 控制 的 需求 ， 
同时 还 要 面 对 不 可 忽视 的 不 确定 性 因素 和 各 种 噪 
声 。 机 器 人 系统 需要 在 不 可 预知 的 情境 下 完成 任 
务 ， 既 要 监测 这 些 情 境 的 变化 ， 又 要 作出 适当 的 响 
应 。 所 有 这 些 任务 都 需要 并 发 地 、 异 步 地 执行 ， 这 
无 疑 会 大 大 增加 系统 的 复杂 性 。 

采用 精心 构思 的 体系 结构 ， 再 加 上 支持 该 体系 
结构 的 编程 工具 ， 则 有 助 于 解决 这 些 复杂 性 问题 。 
目前 ， 还 没有 哪 一 种 体系 结构 是 万 能 的 ， 尺 有 所 短 
寸 有 所 长 ， 每 种 体系 结构 都 有 着 不 同 的 适用 领域 。 
针对 特定 应 用 进行 体系 结构 选 型 时 ， 要 深入 了 解 各 
种 体系 结构 的 优 缺点 ， 这 一 点 非常 重要 。 

本 章 详 述 建立 机 器 人 体系 结构 的 各 种 方法 。 首 
先 介绍 基本 术语 及 相关 概念 (包括 机 器 人 体系 结 
构 的 发 展 历程 )， 然 后 深入 探讨 目前 的 体系 结构 中 
常用 的 几 种 组 件 ， 包 括 行为 控制 〈 详 见 第 38 章 )、 
执行 、 任 务 规划 ( 详 见 第 9 章 ) 以 及 这 些 组 件 互 
连 的 常用 技术 。 作 为 重点 ,支持 这 些 体系 结构 的 编 


8.1 概述 


机 器 人 体系 结构 这 一 术语 常 包 括 两 层 含义 ， 既 相 
联系 又 有 区 别 。 一 是 “结构 ”之 意 ， 指 一 个 系统 如 
何 划分 为 子 系统 以 及 这 些 子 系统 之 间 如 何 相互 作用 。 
机 器 人 系统 的 结构 常用 框图 进行 形式 化 表示 ， 或 者 更 
正式 一 些 采 用 统一 建 模 语言 (UML) 技术 来 描 
述 “ 1 。 二 是 “风格 ”之 意 ， 指 支撑 特定 系统 的 计算 
模式 。 璧 如 ， 有 的 机 器 人 系统 采用 发 布 /订阅 进行 消 


Wim | 


程 工具 和 开发 环境 贯穿 全 文 。 接 下 来 给 出 一 个 体系 
结构 实例 ， 最 后 进行 扼要 的 总 结 ， 并 介绍 一 些 可 供 
扩展 阅读 的 文献 资料 。 
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能 无 法 清晰 界定 子 系统 的 边界 ， 从 而 很 难 明 确 地 说 
它 确 属 哪 种 结构 ， 同 样 ， 体 系 结构 又 与 特定 领域 的 
实现 紧密 联系 在 一 起 ， 其 设计 风格 上 也 没有 清晰 的 
界线 。 

上 述 情 况 很 令 人 遗憾 。 因 为 一 个 精心 设计 的 、 清 
晰 的 体系 结构 特别 有 利于 机 器 人 系统 的 规格 说 明 、 执 
行 和 验证 。 一 般 情 况 下 ， 机 器 人 的 体系 结构 可 以 对 机 
器 人 系统 的 设计 和 实现 施加 恰当 的 〈 不 能 过 于 严格 ) 
约束 条 件 ， 从 而 有 助 于 加 速 开 发 进程 。 例 如 ， 将 行为 
组 件 划分 成 模块 单元 ， 便 有 助 于 增加 其 可 理解 性 和 可 


四 | MS 


TER 


息 传 递 的 通信 模式 ， 而 有 的 则 采用 更 加 同步 的 客户 
机 /服务 器 模式 。 

所 有 机 器 人 系统 都 要 采用 某 种 体系 结构 和 计算 
模式 ， 但 是 很 难 精确 地 说 现 有 的 系统 具体 用 的 是 哪 
一 种 。 实 际 上 ， 就 算是 单个 的 机 器 人 系统 ， 往 往 也 
揉 合 了 若干 种 计算 模式 。 这 是 因为 ， 系 统 实 现时 可 


TTE, ， 且 便于 单元 测试 与 验证 
8.1.1 机 器 人 体系 结构 的 特殊 需求 


从 某 种 意义 来 讲 ， 机 器 人 体系 结构 设计 可 以 被 看 
成 是 软件 工程 。 但 机 器 人 体系 结构 又 因 机 器 人 系统 的 
特殊 需求 而 有 别 于 其 他 软件 体系 结构 。 从 体系 结构 的 


o 
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视角 看 ， 这 些 需求 中 最 主要 的 是 机 器 人 系统 要 与 不 确 


层 一 一 每 层 的 任务 通过 调用 其 下 一 层 的 一 组 任务 来 


定 的 、 又 经 常 是 动态 的 环境 进行 异步 的 、 实 时 的 交 
互 。 此 外 ,很 多 机 器 人 系统 还 需要 在 各 种 时 间 尺 度 上 
做 出 响应 ， 从 毫秒 级 反馈 控制 到 分 钟 级 、 小 时 级 的 复 
杂 任 务 处 理 。 

为 了 满足 上 述 需 求 ， 很 多 机 器 人 的 体系 结构 都 包 
含 了 实时 行动 、 执 行 器 及 传 感 吉 控制 、 并 发 支持 、 异 
常情 况 检 测 与 响应 、 不 确定 性 处 理 、 高 级 (符号 级 ) 
规划 与 低级 (数值 级 ) 控制 集成 等 多 种 能 


完成 9 。 在 某 些 情 况 下 ， 基 于 空间 抽象 进行 分 解 
会 更 好 ， 比 如 既 要 处 理 局 部 导航 又 要 处 理 全 局 导航 
的 时 候 gm 。 最 主要 的 一 点 是 ， 不 同 的 应 用 场合 需 
要 用 不 同 的 分 解 方式 ， 而 采用 的 结构 模式 则 要 与 之 
相 适应 。 


8.1.3 软件 开发 工具 
采用 明确 定义 的 结构 模式 来 设计 系统 其 好 处 是 很 


尽管 同样 的 能 力 可 以 采用 不 同 的 结构 模式 来 实 
现 ， 但 采用 某 种 特定 的 模式 可 能 会 好 于 其 他 模式 。 举 
个 例子 ， 现 在 来 看 看 机 器 人 系统 的 通信 模式 能 如 何 影 
响 其 可 靠 性 。 很 多 机 器 人 系统 都 被 设计 成 消息 传递 的 


明显 的 ， 同 时 ， 许 多 结构 模式 也 有 相关 的 软件 工具 ， 
实现 这 种 模式 提供 有 力 的 支持 。 这 些 工 具 以 多 种 形式 
存在 ， 如 函数 库 、 专 用 编程 语言 或 图 形 编辑 咒 。 这 些 
[ 具 屏 蔽 了 概念 上 的 复杂 性 ， 对 结构 模式 的 约束 更 


异步 通信 过 程 。 客 户 机 /服务 器 是 一 种 常用 的 通信 模 
式 ， 在 该 模式 中 , 来 自 客户 机 的 每 个 消息 请 求 都 与 来 
自 服 务 器 的 响应 相对 应 。 发 布 /订阅 是 另 一 种 通信 模 
式 ， 其 中 消息 都 是 被 异步 地 广播 出 去 的 ， 所 有 此 前 提 
出 过 对 这 些 消 息 感 兴趣 的 通信 模块 都 能 收 到 消息 的 副 
本 。 采 用 客户 机 /服务 器 模式 进行 消息 传递 ， 通 信 模 
块 发 送 一 个 请 求 后 就 进入 阻塞 状态 ， 以 等 待 响 应 。 如 


清晰 。 

例如 ， 进 程 间 通信 库 (如 通用 对 象 请 求 代理 体 
系 结构 CORBA) ** 和 进程 间 通 信和 包 (IPC) 59, fk 
得 消息 传递 模式 ( 如 客户 机 /服务 器 和 发 布 /订阅 模 
X) 实现 起 来 非常 轻松 。 诸 如 Subsumption * '°! 和 
Skills* "等 语言 则 有 助 于 开发 数据 驱动 的 、 实 时 行 
为 ， 而 ESL (PITZA) WI PLEXIL (规划 执 


果 所 期 待 的 响应 望 穿 秋 水 也 等 不 来 (如 服务 器 模 块 
崩溃 了 ) ， 则 会 发 生死 锁 。 即 使 请 求 模块 不 阻塞 ， 其 
控制 流 依然 会 期 待 着 响应 。 如 果 响 应 永 不 到 达 或 者 其 
他 请 求 的 响应 不 期 而 至 ， 则 会 发 生 无 法 预料 的 结果 。 
相反 ， 采 用 发 布 /订阅 模式 的 系统 则 更 可 靠 一些 ， 因 
为 消息 都 已 被 假定 为 异步 到 达 的 ， 控 制 流 不 会 再 假设 
按 哪 种 特定 顺序 处 理 消息 ， 所 以 消息 丢 失 或 者 乱 序 
产生 的 影响 就 比较 小 。 


8.1.2 模块 化 与 层次 化 


机 器 人 体系 结构 的 一 个 重要 作用 就 是 将 系统 分 解 
成 更 简单 的 、 在 很 大 程度 上 比较 独立 的 模块 。 正 如 前 
面 讲 过 的 ， 机 器 人 系统 经 常 被 设计 成 通信 过 程 ， 其 通 
信 接 口 很 少 且 带宽 相对 较 低 。 如 此 设计 能 使 通信 模块 
异步 地 处 理 与 环境 的 交互 过 程 ， 且 最 小 化 与 其 他 模块 
的 交互 。 显 然 ， 这 样 可 以 降低 整个 系统 的 复杂 性 ， 增 
加 整个 系统 的 可 靠 性 。 

通常 ， 系 统 的 分 解 是 分 层次 的 些 模块 组 
件 建立 在 男 一 些 模 块 组件 之 上 。 显 式 地 支持 此 类 分 
层 分 解 的 体系 结构 通过 抽象 技术 来 降低 系统 的 复杂 
度 。 然 而 ， 尽 管 机 器 人 系统 的 分 层 分 解 已 是 众望 所 
归 , 但 是 究 竞 沿 着 哪 一 个 维度 进行 分 解 还 是 众说 纷 
颖 、 百 花 齐 放 。 有 些 体系 结构 沿 着 时 间 维 进行 分 
解 一 一 每 层 操作 的 响应 频率 都 比 其 下 一 层 低 一 个 数 
量 级 *”。 而 有 些 体系 结构 则 基于 任务 抽象 进行 分 


[m 


行 交 换 语言 )*“ B DUE A np S SX ES DT 45 3E 
支持 。 对 于 图 形 编辑 器 ， 如 ControlShell'* “! | Lab- 
view* ^ fl ORCCAD (开放 机 器 人 控制 器 计算 机 辅助 
设计 ) 中 等 ， 则 为 系统 集成 提供 了 约束 方式 ， 并 可 
自动 生成 支持 该 结构 模式 的 代码 。 

无 论 哪 种 情况 ， 这 些 工 具 都 可 以 使 特定 模式 的 软 
件 开 发 变 得 很 容易 。 更 重要 的 是 ， 它 们 可 以 确保 不 
至 少 是 很 难 ) 违背 结构 模式 的 约束 条 件 。 于 是 ， 用 
这 些 工 具 开 发 的 系统 更 易于 实现 、 理 解 、 调 试 、 验 证 
和 维护 。 同 时 这 些 系统 也 更 可 靠 ， 因 为 这 些 软件 工具 
为 控制 结构 的 一 般 需 求 提供 了 和 良好 的 设计 能 力 ， 如 消 
息 传 递 、 与 执行 器 和 传感器 的 接口 以 及 并 发 任务 处 
理 等 。 


— 


8.2 发 展 历程 


机 器 人 体系 结构 和 程序 设计 始 于 20 世纪 60 年 代 
未 斯 坦 福 大 学 的 Shakey HLEA!) (如 图 8.1 所 
示 ) 。Shakey 装配 有 1 台 摄 像 机 、1 台 测 距 仪 和 碰撞 
检测 传感器 ， 并 通过 无 线 和 视频 链 路 连接 到 DEC 
PDP10 和 PDP- 15 计算 机 。Shakey 的 体系 结构 被 分 解 
为 3 个 功能 单元 : 感知 、 规 划 和 执行 "1。 感 知 系统 
将 摄像 机 采集 的 图 像 转换 为 内 部 环境 模型 。 规 划 器 接 
受 根 据 内 部 环境 模型 和 目标 生成 一 个 可 以 达到 目标 的 
规划 〈 即 动作 序列 ) 。 执 行 器 接收 规划 结果 并 给 机 器 
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人 发 出 动作 指令 。 上 述 方法 被 称 为 感知 - 规划 -动作 
(SPA) 范 型 (如 图 8.2 所 示 )。 这 种 体系 结构 的 主要 
寺 点 是 : 感知 数据 被 转换 为 一 个 环境 模型 ， 该 模型 为 
规划 器 所 用 ， 规 划 执行 时 不 再 直接 与 传感器 打交道 。 
其 后 很 多 年 ， 机 器 人 的 控制 结构 和 程序 设计 几乎 无 一 
例外 地 都 采用 了 SPA 范 型 。 


n 
ea 
E: 
感知 
建 模 
规划 
任务 执行 
马达 控制 
= 
m 
E: 


图 8.2 感知 - 规划 -动作 (SPA) 范 型 
〈 引 自 文献 [8.3 ] ,许可 使 用 ) 


8.2.1 包容 结构 


20 世纪 80 年 代 初 ，SPA 范 型 的 问题 逐渐 暴露 出 
来 。 第 一 ， 在 真实 环境 中 进行 规划 耗 时 太 长 ， 机 器 人 
此 时 处 于 阻塞 状态 等 待 规划 结果 。 第 二 ， 也 是 更 重要 
的 一 点 ， 规 划 执行 时 不 再 处 理 感知 信息 ， 这 在 动态 环 
境 中 是 很 危险 的 。 于 是 一 些 新 型 的 机 器 人 控制 结构 范 
型 开始 名 露头 角 ， 其 中 包括 反应 型 规划 ， 可 以 快速 生 
成 规划 结果 ， 且 规划 过 程 更 直接 地 依赖 于 感知 信息 而 
不 是 内 部 模型 中 。 最 有 影响 力 的 一 项 成 果 是 
Brooks 提出 的 包容 结构 号 2 。 包 容 结构 由 相互 作用 的 
有 限 状 态 机 分 层 构成 一 一 每 层 都 是 把 传感器 和 执行 器 
直接 连接 起 来 (如 图 8.3 所 示 ) 。 这 些 有 限 状 态 机 被 
称 为 行为 《有 人 因此 将 包容 结构 称 为 基于 行为 的 机 
器 人 或 者 行为 机 器 人 技术 *“"”， 参 见 第 38 章 ) 。 因 为 
任 一 时 刻 都 能 有 多 种 行为 被 激活 ， 所 以 包容 结构 设计 
了 仲裁 机 制 ， 使 得 高 级 行为 能 够 抑制 低级 行为 。 例 
如 ， 机 器 人 可 以 有 一 种 简单 地 随机 游 走 的 行为 ， 这 种 
行为 总 是 处 于 激活 状态 ， 于 是 机 器 人 总 是 这 儿 走 走 那 
儿 走 走 。 片 刻 之 后 ， 高 级 行为 接收 到 传感器 的 输入 信 
息 ， 检 测 到 有 障碍 物 ， 于 是 操纵 机 器 人 远离 障碍 物 。 
高 级 行为 也 总 是 处 于 激活 状态 。 在 没有 障碍 物 的 环境 
中 ， 高 级 行为 从 不 生成 信号 ， 但 若 检测 到 障碍 物 ， 它 
便 抑 制 低级 行为 而 操纵 机 器 人 离开 。 一 旦 障碍 物 消 失 
(高 级 行为 停止 发 送信 号 ) ， 低 级 行为 便 重 新 获得 控 
制 权 。 增 加 行为 交互 层 就 可 以 构建 出 越 来 越 复 杂 的 机 
器 人 。 


图 8.3 包容 结构 实例 ( 引 自 参考 文献 [8.3 ] ， 许 可 使 用 ) 


有 不 少 机 器 人 是 采用 包容 方法 构建 的 ， 且 大 部 分 
都 在 MIT'S ”1， 均 相当 成 功 。 相 比 SPA 机 器 人 的 反 
应 迟钝 、 动 作 策 拙 ， 包 容 机 器 人 则 反应 灵敏 、 动 作 迅 


捷 。 它 们 不 会 被 动态 变化 的 环境 所 困扰 ， 因 为 它们 持 
续 地 感知 环境 并 做 出 反应 。 这 些 机 器 人 能 像 昆 虫 或 小 
型 哮 齿 动物 一 样 跑 来 跑 去 。 除 了 包容 结构 ， 还 有 男 外 
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几 种 行为 结构 ， 通 常 都 有 不 同 的 仲裁 方案 来 融合 行为 


A + FAL [8. 23,24 
出 结果 : 


Arkin 提出 的 马达 -控制 图 式 世 汪 也 是 一 种 常见 的 
基于 行为 的 体系 结构 。 在 这 种 生物 启发 的 方法 中 ， 马 
达 与 知觉 图 式 *“” 被 动态 地 互 连 起 来 。 马 达 图 式 基于 


随后 ， 人 们 又 开发 了 不 少 与 3T 结构 (如 图 8.4 
所 示 ) 类 似 的 体系 结构 。ATLANTISW 77 便 是 一 例 ， 
它 将 更 多 的 控制 功能 留 给 了 序列 层 。 在 该 体系 结构 
中 ， 慎 思 层 必须 明确 地 被 序列 层 调 用 。Saridis 提出 的 
智能 控制 结构 中 裤 也 是 一 例 ， 它 使 用 Vxwork 操作 系 


知觉 图 式 生成 响应 向 量 ， 然 后 用 与 势 场 法 * ”| 相似 的 
方式 组 合 起 来 。 为 了 完成 更 复杂 的 任务 ， 自 主机 絮 人 
体系 结构 (AuRA)*“”” 中 还 将 基于 有 限 状 态 接收 器 


统 和 VME 总 线 ， 底 层 是 伺服 系统 ， 并 将 上 一 层 的 执 
行 算法 也 集成 进来 。 上 一 层 由 一 组 能 对 低层 子 系统 
(如 视觉 、 手 臂 运动 和 导航 ) 进行 协调 的 例 程 构成 ， 


(FSA) 的 导航 规划 器 和 规划 序列 器 加 入 到 反应 图 
BO 

然而 好 景 不 长 ， 基 于 行为 的 机 器 人 不 和 久 就 暴露 出 
了 能 力 上 的 局 限 。 它 很 难 把 行为 组 合 起 来 去 实现 长 远 
目标 ， 它 也 几乎 不 可 能 对 机 器 人 的 行为 进行 优化 。 例 
如 ， 想 造 一 台 能 在 办 公 楼 里 投递 信件 的 基于 行为 的 机 
器 人 很 容易 ， 只 要 能 进行 简单 的 办 公 楼 漫游 ， 并 设计 
一 个 搜索 房间 的 行为 通过 抑制 漫游 即 可 进入 办 公 室 。 
但 如 果 用 行为 结构 模式 去 设计 一 个 系统 ， 能 根据 当天 
的 邮件 进行 推理 ， 按 照 最 优 顺序 进入 办 公 室 从 而 最 小 
化 投递 时 间 ， 则 难于 上 青天 。 其 实 ， 机 絮 人 最 需要 的 
是 将 早期 体系 结构 的 规划 能 力 与 基于 行为 的 体系 结构 
的 反应 能 力 紧密 结合 起 来 ， 这 便 催生 了 机 絮 人 的 分 层 
或 分 级 控制 结构 。 


8.2.2 分 层 控制 结构 


Firby 开发 的 反应 动作 包 (RAP) 系统 是 向 反应 
与 慎 思 相 集成 而 迈 出 第 一 步 后 所 取得 的 成 果 之 一 。 在 
Firby 的 论文 中， 可 以 看 到 第 一 个 集成 方案 
三 层 结构 。 其 中 的 中 间 层 即 RAP 系统 ， 是 论文 的 核 
心 内 容 。Firby 也 构思 了 其 他 两 层 的 形式 和 功能 ， 尤 
其 想到 要 把 传统 的 慎 思 方法 与 当时 初 露 端 倪 的 情境 推 
理 技术 结合 起 来 ,可惜 未 能 实现 。 后 来 ，Firby 将 
RAP 与 低级 的 控制 层 集 成 到 了 一 起 1。 

与 此 同时 ，MITRES 的 Bonasso 也 独立 设计 出 了 一 
种 体系 结构 ， 底 层 用 Rex 语言 将 机 器 人 行为 编程 为 同 
AGIA PES) ， 这 些 被 称 为 Rex 机 的 回路 能 够 确保 Agent 
内 部 状态 与 所 处 环境 的 语义 一 致 性 。 中 间 层 是 采用 
GAPPS 语言 “实现 的 条 件 序列 器 ， 能 够 不 断 地 激活 
和 抑制 Rex 技能 直到 机 器 人 完成 任务 。 基 于 GAPPS 的 
序列 器 很 受 青睐 ， 因 为 它 综合 了 众多 的 传统 规划 技 
ARS) 。 这 项 成 果 在 3T 结构 ( 因 其 集成 了 规划 、 序 列 
化 和 实时 控制 这 3 个 控制 过 程 并 构成 3 个 层级 而 得 名 ) 
中 登峰造极 ,已 被 用 在 几 代 机 器 人 上 。 


I 


o PEATE: BS T JERURITEB BUE 


采用 Petri 网 转换 器 (PNT) 实现 (PNT 是 一 种 调度 
机 制 ) ， 由 与 组 织 层 相连 接 的 调度 器 来 激活 。 组 织 层 
是 一 个 用 Boltzmann 神经 网 络 实现 的 规划 器 ， 神 经 网 
络 主要 用 来 计算 满足 要 求 (这 些 要 求 是 以 文本 格式 
输入 进来 的 ) 的 动作 序列 ， 然 后 ， 调 度 器 通过 PNT 
协调 器 来 逐步 执行 规划 结 


m 三 三 三 三 三 — 
[ 

执行 导 Eus TED 立即 动作 记忆 
& 

tosta ee 


环境 
图 8.4 三 层 结构 原型 


自主 系统 体系 结构 LAAS 是 一 种 每 层 都 有 软件 工 
AHA RM KAS?! 。 最 底层 (功能 层 ) 由 
模块 网 络 构成 ， 这 些 模块 都 是 由 动态 参数 控制 的 感知 
算法 ,采用 GenoM (模块 生成 器 ) 语言 写成 ，GenoM 
能 生成 标准 模板 以 便于 模块 集成 。 与 其 他 多 大 数 三 层 
结构 都 不 同 ，LAAS 的 执行 层 相 当 简 单 ， 只 有 纯粹 的 
反射 ， 而 不 对 任务 做 任何 分 解 ， 它 只 是 起 到 一 个 桥梁 
作用 一 一 从 高 层 接收 任务 序列 ， 做 出 选择 和 参数 化 处 
理 后 送 到 功能 层 。 执 行 层 由 Kheops 语言 写成 ， 该 语 
言 能 够 自动 生成 可 以 被 形式 化 验证 的 决策 网 。 最 上 面 
的 决策 层 由 规划 器 和 监督 器 构成 ， 规 划 器 是 用 FTeT 
(索引 时 间 表 ) 时 序 规划 器 “实现 的 ， 监 督 器 是 
用 PRS (过 程 推理 系统 ) 天 ”实现 的 。 监 督 器 与 其 
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他 类 型 三 层 结构 的 执行 层 类 似 ， 能 对 任务 进行 分 解 、 
对 可 互 换 方法 进行 选择 、 对 执行 进行 监测 。 通 过 将 规 
划 器 和 监督 器 集 于 一 层 ，LAAS 使 这 二 者 结合 更 紧 


文献 中 还 有 一 些 值得 注意 的 多 层 体系 结构 。 由 美 
国 国家 标准 局 (NBS) 为 美国 航空 航天 局 (NASA) 
开发 的 NASA/NBS 标准 参考 模型 ( NASREM) *^*! 


密 ， 在 何 时 重 规划 、 如 何 重 规划 方面 就 有 了 更 大 的 灵 
活性 。 实 际 上 ，LAAS 体系 结构 允许 在 较 高 级 的 抽象 
层 上 有 多 个 决策 层 ， 如 较 高 级 的 使 命 屋 和 较 低级 的 任 
务 层 。 

遥控 Agent 是 飞船 自主 控制 的 体系 结构 号 ” ， 它 
实际 上 是 由 4 层 构成 ， 即 控制 层 〈 也 称 行为 层 ) 、 执 
行 层 、 规 划 层 (或 调度 层 ) 以 及 MIR (模式 鉴别 与 
恢复 ) Ei, MIR 层 包 括 故 障 检测 与 恢复 功能 。 控 制 
层 就 是 传统 的 飞船 实时 控制 系统 。 执 行 层 是 该 体系 结 
构 的 核心 ， 它 能 分 解 、 选 择 和 监测 任务 的 执行 ， 能 执 
行 故障 恢复 以 及 资源 管理 (适时 地 启动 和 关闭 设备 
以 节约 有 限 的 飞船 电力 )。 规 划 器 (调度 器 ) 是 一 个 
批 处 理 过 程 ， 它 根据 目标 、 初 始 (发 射 时 的 ) 状态 
和 当前 计划 活动 生成 规划 。 这 些 规划 可 以 是 从 任务 启 
动 到 结束 之 间 任 一 时 段 。 规 划 中 也 可 以 包含 “重新 
调用 规划 器 生成 下 一 阶段 规划 ”的 任务 。 配 置 管理 
是 遥控 Agent 中 的 一 个 重要 部 分 ， 它 可 以 配置 硬件 以 
支持 任务 ， 并 监测 硬件 保持 在 已 知 的 、 稳 定 的 状态 。 
配置 管理 的 角色 被 划分 到 执行 层 和 MIR 层 两 层 中 ， 
执行 层 中 主要 使 用 反射 过 程 ，MIR 层 中 使 用 飞船 已 声 
明 的 模块 和 慎 思 算法 来 确定 如 何 重新 配置 硬件 以 响应 
检测 到 的 故障 中 。 

eer p SSMUS I aT 模式 拓展 到 多 机 器 人 协 
调 领 域 ( 见 第 40 章 ) 。 在 该 体系 结构 中 ， 每 层 不 仅 
与 上 下 层 有 接口 ， 还 与 其 他 机 器 人 的 同一 层次 有 接 
口 ， 如 图 8.5 所 示 。 这 样 一 来 ， 分 布 式 控制 环 可 以 设 
计 在 多 个 抽象 级 别 上 。 参 考 文献 [848] 中 的 联合 
体系 结构 ， 其 规划 器 使 用 基于 分 布 式 市 场 的 方法 进行 


任务 分 配 。 


a 


TE | 执行 层 
行为 控制 层 行为 控制 层 


图 8.5 联合 多 机 器 人 体系 结构 


行为 控制 层 


就 是 早期 的 遥 操 作 机 器 人 参考 模型 ， 如 图 8. 6 所 示 ， 
后 来 被 称 为 实时 控制 系统 (RCS ) 。 它 是 一 个 多 层 模 
型 ， 每 层 都 采用 相同 的 通用 结构 ， 从 伺服 层 到 推理 
层 ， 随 着 抽象 程度 的 升 高 ， 操 作 频 率 不 断 降低 。 除 维 
护 全 局 环境 模型 外 ，NASREM 和 3T 结构 一 样 一 开始 
就 提供 了 所 有 数据 和 控制 路 径 。 但 NASREM 只 是 个 
参考 模型 ， 并非 具 体 实 现 。NASREM 后 来 的 实现 基 
本 都 是 遵从 SPA 方法 做 的 ， 且 主要 应 用 在 遥 操 作 机 
器 人 (而 不 是 自主 机 器 人 ) E, 但 Blidberg 早期 的 工 
Pets?) A BSP 


感知 值 判定 
过 程 环境 建 模 行为 生成 


图 8.6 实施 控制 系统 (RCS ) 参考 体系 结构 
( 引 自 参考 文献 [8. 46 ] ， 许 可 使 用 ) 


在 机 器 人 三 层 体系 结构 争奇斗艳 的 时 候 ， 各 种 
双 层 体系 结构 也 在 悄然 绽放 。 自 主机 器 人 双 层 体系 
结构 (CLARAty) 就 是 被 设计 成 用 来 支持 NASA 空 
间 机 器 人 (特别 是 行星 漫步 者 机 器 人 ”1 ) 的 软 
件 可 重用 的 。CLARAty 由 一 个 功能 层 和 一 个 决策 层 
构成 。 功 能 层 是 一 个 面向 对 象 算法 层 ， 能 提供 众多 
到 机 器 人 的 抽象 接口 ， 如 马达 控制 、 载 体 控制 、 基 
于 传感器 的 导航 和 移动 操作 等 。 每 个 对 象 都 提供 
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般 的 〈 不 依赖 于 硬件 的 ) 接口 ， 因 此 相同 的 算法 可 
以 运行 在 不 同 的 硬件 上 。 决 策 层 融合 了 规划 和 执行 
能 力 ， 与 LAAS 体系 结构 一 样 ， 可 以 紧密 协调 规划 
和 执行 ， 使 得 为 响应 动态 的 偶然 事件 而 连续 进行 重 
规划 成 为 可 能 。 

CLARAty 的 决策 层 具 体 说 就 是 个 CLEaR (闭环 
执行 与 恢复 ) 中 31 ， 它 将 基于 修复 的 规划 器 CASPER 
(连续 动作 调度 、 规 划 、 执 行 与 重 规划 )*1 和 TDL 
(任务 描述 语言 )“*” 组 合 起 来 。CLEaR 为 目标 驱动 
的 行为 和 事件 驱动 的 行为 提供 了 一 种 紧 耦 合 方法 。 根 
据 执 行 监测 进行 高 频 度 的 状态 与 资源 更 新 ， 然 后 快速 
处 理 、 连 续 重 规划 的 能 力 ， 是 CLEaR 的 核心 内 容 。 
这 使 得 规划 器 可 以 处 理 很 多 异常 情况 ， 这 在 任务 多 、 
资源 少 、 不 确定 性 强 的 情况 下 尤为 重要 。 在 CLEaR 
中 ， 规 划 和 执行 组 件 都 能 处 理 资 源 冲突 和 异常 情况 ， 
在 特定 的 情况 下 ， 采 用 启发 式 方法 来 确定 该 调用 哪个 
AE, OASIS (机 载 自主 科 考 系统 ) l 对 CLEaR 进 
行 了 拓展 ， 将 科学 数据 分 析 功 能 也 纳入 其 中 ， 于 是 ， 
这 种 体系 结构 还 可 以 由 带 有 机 缘 巧 合 性 质 的 科学 目标 
来 驱动 ， 如 寻找 特殊 的 岩石 或 构造 。OASIS 是 以 规划 
器 为 中 心 的 ， 在 任务 调度 开始 前 仅 需 几 秒 钟 就 可 以 将 
任务 发 送 到 执行 组 件 。 

协作 智能 实时 控制 体系 结构 (CIRCA) 也 是 一 种 
双 层 结构 ， 它 关注 的 是 如 何 确保 可 靠 行 为 7 。 它 
实现 了 有 界 反 应 ， 这 是 一 种 机 器 人 资源 不 总 是 那么 充 
足 时 为 保证 完成 所 有 任务 而 采取 的 响应 。CIRCA 由 
实时 系统 (RTS) 和 相当 独立 的 人 工 智 能 系统 
(AIS) 构成 。RTS 执行 测试 动作 对 (TAP) 周期 调 
度 ，TAP 已 经 根据 感知 到 的 环境 信息 和 有 条 件 的 响应 
动作 确保 了 最 坏 情况 下 的 行为 。AIS 的 职责 是 创建 调 
度 ， 且 确保 在 实时 执行 期 间 不 出 现 灾难 性 故障 。AIS 
是 通过 在 状态 转移 图 上 的 规划 来 做 到 这 一 点 的 ， 状 态 
转移 图 中 包括 动作 、 外 部 事件 和 时 间 流 逝 (机 器 人 
等 待 时 间 太 久 也 会 发 生 不 测 ) 造成 的 状态 转移 。AIS 
测试 每 一 个 规划 (TAP 集 )， 看 其 是 否 能 被 实际 调 
度 。 如 果 不 能 ， 则 调换 一 个 规划 模型 一 一 或 者 剔除 任 
务 (根据 目标 优先 级 ) ,或 者 调整 行为 参数 (如 降低 
机 器 人 速度 ) 。AIS 如 此 往复 ， 直 到 找到 一 个 可 以 成 
功 调度 的 规划 为 止 ， 然 后 便 将 这 个 新 规划 在 一 个 原子 
操作 步骤 内 下 载 到 RTS 中 。 


和 CIRCA 一 样 ， 前 面 提 到 过 的 ORCCAD 也 是 一 
个 确保 可 靠 性 的 双 层 体系 结构 *%” ， 不 同 的 是 ， 
ORCCAD 是 通过 形式 化 验证 技术 来 实现 这 种 保证 的 。 
机 器 人 任务 (低级 行为 ) 和 机 器 人 过 程 (高 级 动作 ) 
都 是 由 高 级 语言 定义 的 ， 然 后 再 翻译 成 Esterel if 
OO VETTE GL, 或 者 翻译 成 时 控 Argus 语 
言 人 昌 进 行 时 序 验证 。 这 些 验证 方法 要 做 些 调整 ， 
以 适应 生存 性 、 安 全 性 以 及 资源 冲突 的 验证 。 


8.3 体系 结构 组 件 


本 章 以 三 层 结 构 为 原型 探讨 体系 结构 组 件 。 图 
8.4 给 出 了 一 种 典型 的 三 层 体 系 结构 。 其 底层 为 行为 
控制 层 ， 与 传感器 和 执行 器 紧密 相连 。 第 二 层 为 执 
行 层 ， 负 责 选 择机 器 人 当前 行为 以 完成 任务 。 最 高 
层 是 任务 规划 层 ， 负 责 在 资源 约束 条 件 下 实现 机 器 
人 的 长 远 目标 。 以 办 公 室 投递 机 器 人 为 例 ， 行 为 层 
负责 机 器 人 在 房间 和 走廊 中 的 移动 、 避 障 和 开门 等 ， 
执行 层 协调 行为 层 以 完成 任务 ， 如 离开 房间 、 进 入 
办 公 室 等 ， 任 务 规划 层 负责 确定 最 省 时 间 的 投递 顺 
序 、 考 虑 投递 优先 级 、 调 度 、 充 电 等 ， 并 将 任务 
(如 退出 房间 、 进 入 110 室 ) 发 送 到 执行 层 。 上 述 
各 层 需 要 协同 工作 并 且 交 换 信息 。 下 一 节 先 研究 各 
日 件 的 连接 问题 ， 然 后 逐一 探讨 三 层 结构 中 的 各 个 
AVF 


8.3.1 


ANS NS 


连接 组 件 


本 章 探讨 过 的 所 有 体系 结构 组 件 之 间 都 需要 通 
信 ， 包 括 交换 数据 和 发 送 指令 。 组 件 通信 (和 常 称 为 
中 间 件 ) 模式 的 选择 是 机 器 人 体系 结构 设计 者 做 很 
多 决策 时 必须 考虑 的 最 重要 的 、 约 束 性 最 强 的 问题 之 
一 。 根 据 以 往 的 经 验 ， 开 发 机 器 人 体系 结构 时 ， 很 多 
问题 都 与 组 件 间 的 通信 有 关 ， 且 大 量 的 调试 时 间 也 花 
在 这 里 。 此 外 ,一 旦 选 定 了 某 种 通信 机 制 ， 再 就 极 难 
更 改 ， 因 此 初期 的 决策 多 少年 都 不 再 改变 。 很 多 开发 
者 使 用 他 们 自己 的 通信 协议 ， 这 些 协 议 通常 是 基于 
Unix 套 接 字 开发 的 。 尽 管 这 样 做 可 以 对 消息 进行 定 
制 , 但 是 可 靠 性 、 高 效 性 和 外 部 通信 包 的 易 用 性 等 优 
势 将 难以 发 挥 出 来 。 目 前 有 两 种 基本 的 通信 方法 一 一 
客户 机 /服务 器 和 发 布 /订阅 。 


WE: Esterel 语言 是 一 种 用 于 开发 复杂 反应 系统 的 同步 程序 设计 语言 。 


O PARE. 一 种 用 于 开发 分 布 式 程序 的 语言 。 
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1. 客户 机 /服务 器 

在 客户 机 /服务 器 (也 称 点 对 点 ) 通信 协议 中 ， 
组 件 之 间 直 接 对 话 。 远 程 过 程 调用 (RPC) 协议 便 是 
一 个 很 好 的 例子 ，RPC 中 一 个 组 件 (作为 客户 机 ) 
可 以 调用 另 一 个 组 件 (作为 服务 器 ) 的 函数 和 过 程 。 
目前 很 流行 的 一 种 形式 是 通用 对 象 请 求 代理 体系 结构 
(CORBA), CORBA 允许 一 个 组 件 调用 另 一 个 组 件 实 
现 的 对 象 方法 ， 所 有 的 方法 调用 都 在 一 个 不 依赖 于 编 
程 语言 的 IDL (接口 定义 语言 ) 文件 中 定义 ， 每 个 组 
件 都 使 用 相同 的 IDL 来 生成 代码 ， 并 与 组 件 一 起 编译 
用 以 处 理 通信 事务 。 这 样 做 的 好 处 是 ， 当 IDL 文件 改 
变 时 ， 使 用 该 IDL 的 所 有 组 件 可 以 自动 地 被 重新 编译 
(使 用 make 或 类 似 的 代码 配置 工具 ) CORBA 对 象 


字符 串 类 型 中 ， 往 往 都 是 到 运行 时 组 件 尝试 解析 一 个 
接收 到 的 消息 失败 时 间 题 才 能 暴露 出 来 。 发 布 /订阅 
协议 在 用 于 由 一 个 模块 向 另 一 个 模块 发 送 命令 时 可 读 
性 也 不 好 ， 命 令 不 是 调用 显 式 的 方法 或 函数 ( 含 参 
数 ) ， 而 是 通过 发 布 消息 的 方式 发 出 ， 消 息 中 包含 命 
令 和 参数 ， 这 些 消息 由 订阅 者 去 解析 。 最 后 ， 发 布 / 
订阅 协议 常用 单一 的 中 央 服 务 器 给 所 有 订阅 者 分 发 消 
息 ， 存 在 单 点 失效 和 瓶颈 问题 。 

3. JAUS 

近年 来 ,在 国防 机 器 人 技术 领域 浮现 出 一 套 标 
准 ， 不 仅 对 通信 协议 作 了 规范 ， 而 且 对 经 由 通信 协议 
传递 的 消息 的 定义 也 作 了 规范 。JAUS (无 人 系统 联 
合体 系 结构 ) 定义 了 一 套 可 重用 的 消息 与 接口 ， 可 


请 求 代理 (ORB) 在 很 多 主流 面向 对 象 语 言 中 都 可 
以 使 用 。 尽 管 有 免费 的 ORB 可 用 ， 但 依然 有 许多 商 
用 ORB 存在 ， 它 们 能 提供 更 多 的 功能 和 更 好 的 技术 
支持 。CORBA 的 不 足 之 处 是 使 应 用 程序 额外 增加 了 
一 些 代码 。 一 些 竞 争 者 已 经 在 努力 解决 这 个 问题 ， 如 
ICE (Internet 通信 引擎 ) 开发 了 自己 的 IDL 文件 版 
本 ， 称 作 SLICE (ICE 规格 说 明 语 言 ) 。 客 户 机 /服务 
器 协议 最 大 的 优点 是 事先 将 接口 定义 得 非常 清晰 ， 当 
接口 改变 时 ， 大 家 都 能 知道 。 另 一 个 优点 是 在 无 中 心 
模块 又 需要 分 发 数据 时 它 人 允许 分 布 式 通信 方法 。 客 户 
机 /服务 器 协议 的 缺点 是 通信 开销 大 ， 尤 其 在 许多 组 
件 需 要 相同 信息 时 。 需 要 指出 的 是 ，CORBA 和 ICE 
还 具有 广播 机 制 (在 CORBA 中 称 为 事件 通道 或 通知 
服务 ) 。 

2. 发 布 /订阅 

在 发 布 /订阅 (也 称 广播 ) 协议 中 ， 一 个 组 件 发 
布 数据 ， 其 他 任何 组 件 都 可 以 订阅 这 些 数据 。 典 型 
地 ， 一 个 中 央 处 理 程序 在 发 布 者 和 订阅 者 之 间 发 送 数 
据 。 在 一 个 典型 的 体系 结构 中 ， 大 部 分 组 件 既 发 布 信 
息 也 订阅 其 他 组 件 发 布 的 信息 。 现 存 多 种 发 布 /订阅 
中 间 件 解决 方案 ， 机 器 人 中 常用 的 是 RTI 公司 的 DDS 
(数据 分 布 式 服务 ) ， 以 前 叫 NDDS (网 络 数据 分 布 式 
HR) 8°! 。 另 一 种 常用 的 发 布 /订阅 范 型 是 卡 内 基 梅 
隆 大 学 开发 的 IPC*。 很 多 发 布 /订阅 协议 都 使 用 
XML (扩展 标识 语言 ) 定 义 发 布 的 数据 ， 以 图 通过 
HTTP 传输 XML 的 便利 性 ， 这 样 便 允许 基于 Web 的 
应 用 程序 之 间 的 互 操作 。 发 布 /订阅 协议 有 一 个 很 大 
的 优点 是 简单 易 用 且 开 销 低 。 当 不 知道 有 多 少 组 件 需 


用 在 命令 自主 系统 上 *“%$]。 这 些 可 重用 的 组 件 降低 
了 将 新 的 硬件 组 件 集成 到 自主 系统 中 的 开销 。 可 重用 
技术 还 允许 把 为 一 套 自主 系统 开发 的 组 件 拿 到 另 一 套 
自主 系统 上 去 用 。JAUS 有 两 个 组 件 : 一 个 领域 模型 
和 一 个 参考 体系 结构 。 领 域 模型 是 无 人 系统 功能 与 信 
息 的 表示 ， 包 含 对 系统 功能 和 信息 能 力 的 描述 。 前 者 
包括 系统 的 机 动 、 导 航 、 感 知 、 负 载 和 操作 等 能 力 的 
模型 ， 后 者 包括 系统 的 内 部 数据 模型 ， 如 地 图 和 系统 
状态 。 参 考 体系 结构 提供 一 个 明确 定义 的 消息 集 ， 这 
些 消息 引发 动作 的 执行 、 消 息 的 交换 和 事件 的 触发 。 
JAUS 系统 中 发 生 的 每 件 事情 都 是 由 消息 触发 的 ， 这 
种 策略 使 得 JAUS 称 为 一 种 基于 组 件 的 、 消 息 传递 式 
的 体系 结构 。 

JAUS 参考 体系 结构 定义 了 系统 的 层次 (如 图 
8.7 所 示 ) ， 层 次 拓扑 将 系统 定义 为 实现 机 器 人 全 部 
能 力 所 必需 的 机 器 人 本 体 、 操 作 控 制 单 元 (OCU) 
和 基础 结构 的 集合 。 系 统 中 的 子 系统 是 一 些 独立 的 单 
元 (如 机 器 人 本 体 或 0CU) 。 节 点 定义 体系 结构 中 各 
种 处 理 能 力 并 将 JAUS 消息 路 由 到 组 件 。 组 件 提供 各 
种 执行 能 力 并 直接 响应 命令 消息 。 组 件 可 是 传感器 
(如 SICK 激光 传感器 或 视觉 传感器 ) 、 执 行 器 ( 如 操 
作 机 构 或 运动 机 构 ) 或 机 载 设备 (如 武器 或 任务 传 
感 器 ) ， 所 谓 拓 扑 (特定 系统 、 子 系统 、 节 点 和 组 件 
的 布局 ) 是 在 系统 实现 时 根据 任务 需求 确定 的 。 

JAUS 的 内 核 是 一 个 明确 定义 的 消息 集合 。JAUS 
支持 的 消息 类 型 有 : 中 命令 : 引起 模式 改变 或 启动 动 
E, DEW: 用 于 从 组 件 中 请 求 信息 。@ 告 知 ， 响应 
查询 。@ 事 件 设置 传递 参数 以 对 事件 进行 设置 。 


要 一 个 数据 块 时 〈 如 多 用 户 接口 ) 发 布 /订阅 协议 就 
特别 有 用 了 。 青 有 ， 组 件 也 不 会 被 陷入 到 对 许多 不 同 
来 源 的 信息 重复 请 求 的 困境 之 中 。 发 布 /订阅 协议 通 
常 很 难 调试 ， 因 为 消息 的 语法 经 常 隐藏 在 一 个 简单 的 


@@ 事 件 通知 : 当时 间 发 生 时 发 送 通知 。 

JAUS 有 大 约 30 条 预定 义 消息 可 供 机 器 人 控制 之 
用 。 有 控制 机 器 人 本 体 的 消息 ， 如 “全 局 向 量 驱 动 
器 消息 ”执行 移动 机 器 人 期 望 全 局 首 向 、 高 度 和 速度 
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图 8.7 JAUS 参考 体系 结构 拓扑 ( 引 自 JAUS 参考 体系 结构 文档 (5091) 


的 闭环 控制 。 也 有 传感器 消息 ， 如 “全 局 位 姿 传 感 
器 消息 ”发 布 机 器 人 本 体 的 全 局 位 置 和 朝向 数据 。 
JAUS 中 还 有 操作 消息 ， 如 “设置 关节 位 置 消息 ”会 
设置 预期 的 关节 位 置 值 , “设置 工具 点 消息 ”会 在 末 
端 执行 器 的 坐标 系统 中 设 定 末 端 执行 器 工具 点 的 
坐标 。 

JAUS 也 有 用 户 自 定义 消息 ， 由 消息 头 和 跟随 的 
特定 格式 构成 ， 其 中 包含 消息 类 型 、 目 的 地 址 (如 
系统 、 子 系统 、 节 点 和 组 件 ) 、 优 先 级 等 。 虽然 JAUS 
主要 是 点 对 点 的 ，JAUS 消息 也 可 以 打上 广播 标记 分 
发 到 所 有 组 件 。JAUS 还 为 导航 和 操作 定义 了 坐标 系 
统 以 确保 所 有 组 件 能 知悉 发 送 给 它们 的 坐标 。 


行为 控制 


8.3.2 


与 执行 器 (轮子 马达 、 操 作 马 达 等 ) 紧密 联系 在 一 
个 反射 环 中 。 在 如 包容 结构 这 样 的 体系 结构 中 ， 所 有 
行为 都 在 一 个 分 层 控制 方案 中 并 发 运行 ， 其 中 某 些 行 
为 会 受到 抑制 。 在 ARA” 中 ， 行 为 由 势 函 数组 合 
ipo, Hof pe ze 8 p 291 则 使 用 显 式 的 仲裁 机 制 从 
潜在 的 冲突 行为 中 进行 选择 执行 。 

在 如 3T*” 这 样 的 体系 结构 中 ， 并 不 是 所 有 的 
行为 都 同时 处 于 活动 状态 。 典 型 地 ， 只 有 少数 不 冲突 
的 行为 才能 同时 处 于 活动 状态 (如 上 例 中 的 行为 2 
和 9)。 执 行 层 (0,8.3.3 节 ) 的 职责 是 激活 或 者 抑 
制 行为 以 完成 高 级 任务 并 避免 两 个 行为 竞争 同一 资源 
(如 一 个 执行 器 ) 的 冲突 。 

2. 情境 行为 

这 些 行 为 有 一 个 重要 特点 就 是 情境 性 ， 也 就 是 说 


行为 控制 在 机 器 人 体系 结构 中 表示 控制 的 最 底 级 
别 ， 它 直接 连接 传感器 与 执行 器 。 尽 管 这 些 行 为 控制 
大 多 都 是 用 C 或 C+ + 语言 手工 写成 的 函数 ， 但 人 们 
还 是 开发 了 一 些 行为 控制 专用 语言 ， 包 括 ALFA, 
TB EC RI Rex 1 。 传 统 的 控制 理论 (如 PID 
PAK. Kalman 滤波 器 等 ) 也 归于 这 一 级 。 在 如 3T 这 
样 的 体系 结构 中 ， 行为 层 像 Brooks 机 一 样 运行 ， 亦 
即 由 少数 几 个 能 感知 环境 并 执行 机 器 人 动作 的 行为 
(也 称 技能 ) 构成 。 

1. 实例 

下 面 来 看 一 个 在 办 公 楼 中 工作 的 投递 机 器 人 ， 其 
行为 控制 层 包 含 了 在 楼 中 移动 并 执行 投递 任务 所 必需 
的 控制 功能 。 假 定 此 机 器 人 已 知 该 楼 地 图 ,那么 ， 它 
可 能 包含 如 下 行为 ; 中 避 障 移动 到 一 个 位 置 ; @ 避 障 
沿 着 走廊 移动 ; 加 找到 一 肩 门 ;由 找到 门 把 手 ; OX 
住 门 把 手 ; @ 拧 开门 把 手 ; @ 从 门 通 过 ; @ 确 定位 
置 ; (9 查看 门牌 号 ; 四 通知 投递 。 

上 述 每 个 行为 都 将 传 感 涡 (视觉 


、 距 离 感知 等 ) 


每 个 行为 仅 在 其 特定 的 场景 中 工作 。 例 如 ， 上 述 的 行 
为 @ 是 沿 着 走廊 移动 ， 但 此 行为 仅 当 机 器 人 身 处 走廊 
时 才 适 用 。 类 伏地 ， 行 为 @ 抓 住 门 把手 ， 也 仅 当 机 器 
人 处 于 能 抓 到 门 把 手 的 距离 范围 内 时 才 适 用 。 将 机 器 
人 放 在 某 一 情境 时 此 行为 会 没有 反应 ,但 它 能 识别 出 
该 情境 是 不 适合 的 ， 也 能 看 出 信号 是 不 对 的 。 

3. 失败 觉察 

对 行为 的 一 项 关键 要 求 是 它们 在 不 工作 的 时 候 应 
该 能 觉察 到 ， 这 称 为 失败 觉察 * ”i 。 例 如 ， 实 例 中 的 
FAQ ( 抓 住 门 把 手 ) 抓 一 次 失败 后 就 不 应 该 在 空 
气 中 连续 里 抓 ， 或 者 更 简单 地 说 ， 不 能 在 撞 了 南 墙 后 
还 不 回头 。 早 期 的 包容 机 器 人 有 一 个 共性 的 问题 ， 即 
行为 不 知道 已 经 失败 而 还 在 继续 采取 动作 ， 结 果 自 然 
没有 进展 。 在 失败 的 情况 下 决策 该 做 什么 不 是 行为 层 
的 任务 ， 行 为 层 只 需要 宣告 行为 失败 、 停 止 活动 。 

4. 实现 约束 

行为 控制 层 设计 的 主要 目的 是 让 机 器 人 控制 能 
现 包 容 结 构 的 快速 性 和 反应 性 。 为 此 ， 行为 控制 层 的 


将 
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行为 需要 遵循 包容 结构 的 套路 ， 尤 其 行为 使 用 的 算法 
要 受 状 态 和 时 间 复杂 度 的 约束 。 在 行为 控制 层 应 该 很 
少 有 或 者 没有 搜索 过 程 ， 很 少 有 迭代 运算 。 行 为 应 该 
就 是 简单 的 传递 函数 ， 从 传感器 或 者 其 他 行为 输入 信 
号 ， 向 执行 器 或 者 其 他 行为 输出 信号 ， 每 秒 重复 这 些 
动作 若干 次 ， 这 样 在 面 对 环 境 改变 时 才能 表现 出 反应 
性 。 争 议 较 多 的 是 在 行为 层 究竟 设置 多 少 个 状态 为 
Ho Brooks 几 年 前 有 一 个 非常 经 典 的 说 法 “最 好 以 世 
界 本 身 作为 模型 "*"1， 也 就 是 说 ， 机 器 人 无 需 维护 
和 查询 环境 的 内 部 模型 ， 取 而 代 之 的 是 直接 感知 环境 
以 获取 数据 。 诸 如 地 图 、 模 型 等 状态 在 三 层 体 系 结构 
中 均 包 含 在 高 层 中 而 不 在 行为 控制 层 中 。 有 些 例外 情 
况 ( 如 维护 数据 滤波 计算 的 状态 ) 则 具体 问题 具体 
4 IT. Gat * "认为 行为 层 保持 的 任何 状态 都 应 该 是 
短暂 的 、 有 限 的 。 


8.3.3 执行 


执行 层 是 行为 控制 层 (数值 运算 ) 与 规划 层 
(符号 运算 ) 之 间 的 接口 。 执 行 层 负责 将 高 级 规划 翻 
译 成 低级 行为 、 在 适当 的 时 候 调用 行为 、 监 测 执行 并 
处 理 异 常 。 有 些 执行 层 也 分 配 资源 并 监测 其 使 用 情 
况 ， 尽 管 这 些 任 务 从 功能 上 大 多 是 该 由 规划 层 执 
行 的 。 

1. 实例 
继续 以 办 公 室 投递 机 器 人 为 例 。 其 高 级 任务 主要 
是 把 邮件 投递 到 一 个 指定 的 房间 ， 执 行 层 将 此 任务 分 
解 成 一 个 子 任务 集 。 它 可 能 使 用 几何 规划 器 来 确定 要 
走 过 的 走廊 和 要 转弯 的 路 口 序列 ， 如 果 沿 线 有 门口 ， 
则 还 会 插入 一 个 任务 去 打开 并 穿 过 此 门 。 在 最 后 一 段 
走廊 中 ， 执 行 层 还 要 增加 一 个 查看 门牌 号 的 并 发 任 
务 。 最 后 的 子 任 务 是 告知 屋 里 的 人 有 信件 ， 同 时 监测 
该 信件 是 否 被 拿 走 。 如 果 过 了 一 段 时 间 信 件 未 被 取 
走 ， 将 触发 一 个 异常 以 调用 一 些 恢复 性 动作 ， 可 能 是 
再 次 告知 ， 可 能 是 检查 是 否 走 对 屋 了 ， 也 可 能 是 通知 
规划 器 稍 后 重新 调度 投递 任务 。 

2. 能 

上 例 中 描述 了 很 多 执行 层 的 能 力 。 一 开始 ， 执 行 
层 就 将 高 级 任务 ( 目标) 分解 成 低级 任务 (行为 )， 
这 典型 的 做 法 就 是 以 过 程 的 方式 来 完成 。 尽 管 有 时 执 
行 层 也 可 以 使 用 专门 的 规划 技术 ， 如 上 例 中 使 用 的 路 
线 规划 器 ， 但 被 编码 在 执行 器 中 的 知识 一 般 还 是 直接 
描述 如 何 完成 任务 ， 而 不 是 先 描述 需要 做 什么 再 由 执 
行 层 自 己 规划 出 怎么 做 。 典 型 的 分 解 是 一 棵 分 层 的 任 
务 树 ， 如 图 8. 8 所 示 ， 任 务 树 的 叶 节 点 是 行为 的 参数 
化 调用 。 


投递 邮件 


( 圆 角 框 为 内 部 节点 ， 和 矩形 为 叶子 节点 ， 六 角形 节点 为 执行 
监 则 器 ， 实 线 箭头 是 父子 节点 关系 ， 虚 线 箭头 是 时 序 约束 ) 
图 8.8 邮件 投递 任务 的 分 层 任务 树 


除了 将 任务 分 解 成 子 任务 ， 执 行 层 还 要 在 任务 之 
间 添 加 和 维护 时 间 约 束 ， 通 常 只 在 同一 层 任务 之 间 才 
加 ,但 也 有 一 些 执行 层 语言 允许 在 任意 任务 对 之 间 加 
上 时 间 约 束 。 最 常见 的 约束 是 串 行 和 并 发 ,但 大 多 数 
执行 层 支 持 更 有 表现 力 的 约束 语言 ， 如 一 个 任务 要 在 
另 一 个 任务 开始 10s 后 开始 ， 或 者 一 个 任务 要 在 男 一 
个 任务 结束 时 结束 。 

当 任务 的 时 间 约 束 条 件 满足 时 ， 执 行 层 负责 派发 
这 些 任 务 。 在 有 些 执行 层 中 ， 任 务 也 可 以 指定 资源 ， 
如 机 器 人 的 马达 或 者 摄像 机 ， 这 些 资源 在 任务 被 派发 
前 必须 可 用 。 和 行为 一 样 ， 在 冲突 的 任务 之 间 进 行 促 
裁 也 是 一 个 问题 。 但 在 执行 层 中 ， 这 种 仲裁 要 么 显 式 
地 编程 实现 〈 如 用 规则 规定 机 器 人 在 试图 避 障 而 优 
离 首选 路 线 的 情况 下 该 做 什么 )， 要么 采用 优先 级 来 
处 理 ( 如 充电 比 投递 邮件 更 重要 )。 

执行 层 的 最 后 两 个 重要 的 能 力 是 执行 监测 和 错 
误 恢复 。 有 人 可 能 会 迷惑 ， 底 层 的 行为 者 那么 可 靠 
了 ,还 要 这 些 能 力 干 什么 ? 原因 有 二 : 其 一 ， 如 
8.3.2 节 所 述 , 行为 是 具有 人 情境 性 的 ， 而 情境 会 不 
可 预期 的 变化 ， 例 如 ， 实 现 一 个 行为 时 可 以 假定 有 
人 能 取 走 邮件 ,但 是 事实 未 必 总 是 如 此 ; 其 二 ， 要 
试图 达到 某 些 目标 ， 行 为 层 可 能 会 将 机 融 人 移动 到 
一 个 执行 层 无 法 预期 的 状态 ， 例 如 ， 人 们 可 以 利用 
机 器 人 的 避 障 行为 将 机 器 人 赶 到 厕所 里 。 尽 管事 实 
上 行为 层 可 以 在 这 样 的 情境 中 保持 机 絮 人 的 安全 ， 
但 执行 层 还 是 需要 对 情境 进行 检测 ， 以 便 使 机 器 人 
回 到 原来 的 路 线 上 。 

典型 地 ， 执 行 监测 被 实现 成 并 发 任务 ， 或 者 直接 
分 析 传 感 器 数据 ， 或 者 在 监测 的 情境 出 现时 激活 一 个 
行为 向 执行 层 发 送信 号 ， 这 些 分 别 对 应 轮 询 与 中 断 驱 
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动 两 种 监测 方式 。 

执行 层 支持 被 触发 的 对 监测 器 的 各 种 响应 。 监 测 
器 可 以 生成 子 任务 来 处 理 某 个 情境 ， 它 可 以 终止 已 经 
生成 的 子 任 务 ， 可 以 引起 父 任务 的 失败 ， 或 者 也 可 以 
产生 一 个 异常 。 后 两 种 响应 涉及 错误 恢复 (也 称 异 
常 处 理 ) 能 力 。 很 多 执行 层 要 求 任务 返回 状态 值 
(成 功 或 失败 )， 并 允许 父 任务 基于 返回 值 有 条 件 地 
执行 。 还 有 一 些 执 行 层 使 用 分 层 异 常 机 制 抛 出 命名 异 
和 常 以 定位 在 任务 树 中 的 节点 。 最 近 的 注册 了 该 异常 处 
理 器 的 子 任务 会 尝试 处 理 这 个 异常 ， 如 果 处 理 不 了 ， 
它 会 将 此 异常 向 任务 树 的 上 一 层 再 次 抛 出 。 这 种 机 制 
是 受 C+ +, Java 和 Lisp 的 异常 处 理 机 制 启发 而 来 
的 ， 它 比 返 回 值 机 制 更 具有 表达 能 力 ， 但 由 于 控制 流 
的 非 局 部 性 特点 ， 使 得 采用 这 种 方法 设计 系统 的 难度 
要 大 得 多 。 

3. 实现 约束 

大 多 数 执行 层 的 主要 形式 是 分 层 有 限 状 态 控制 器 。 
Petri 网 常用 来 表示 执行 层 函数 。 此 外 ， 人 们 还 开发 
了 各 种 语言 专门 来 辅助 程序 员 实 现 执 行 层 的 各 种 能 力 。 
我 们 就 几 个 方面 扼要 讨论 一 下 以 下 几 种 语言 : 反应 动作 
包 (RAP) ** 、 过 程 推理 系统 (PRS) 97. Hg 
持 语 言 (ESL) ") 、 任 务 描述 语言 (TDL) 和 规 
划 执 行 交 换 语言 (PLEXIL) * 9! , 

这 些 语言 既 有 共性 ， 又 有 不 同 。 区 别 之 一 ,语言 
是 独立 的 (RAP、PRS、PLEXIL) 还 是 现 有 语言 的 扩 
展 (ESL 是 通用 Lisp 的 扩展 ，TDL 是 C+ + 的 扩展 ) 。 
独立 语言 总 是 易于 分 析 和 验证 的 ， 但 扩展 语言 灵活 性 
更 好 ， 尤 其 与 已 有 软件 集成 时 更 见 优势 。 尽 管 独 立 的 
执行 层 语言 也 都 支持 用 户 自 定义 函数 接口 ， 但 这 些 接 
口 在 能 力 上 (如 都 有 什么 类 型 的 数据 结构 可 以 传递 ) 
往往 是 有 限 的 。 

所 有 这 些 执行 层 语言 都 对 任务 到 子 任务 的 分 层 分 
解 提供 支持 。 除 PLEXIL 外 所 有 语言 都 允许 任务 的 递 
归 调 用 。RAP、TDL 和 PLEXIL 在 语法 上 能 区 别 任务 
树 (图 ) 的 叶 节 点 和 内 部 节点 。 

所 有 语言 都 提供 了 表示 条 件 和 和 迭代 的 能 力 ， 尽 管 
在 RAP 和 了 PLEXIL 中 这 些 不 是 核心 语言 结构 ， 而 必须 
通过 其 他 结构 的 组 合 来 表示 。 除 了 TDL， 这 些 语言 均 
对 任务 的 前 提 条 件 和 后 续 条 件 的 编码 以 及 成 功 条 件 的 
指定 提供 显 式 的 支持 。 在 TDL 中 ， 这 些 概念 必须 用 
更 基本 的 结构 编程 实现 。 独 立 语言 都 允许 在 任务 描述 
中 定义 局 部 变量 ,但 对 这 些 变量 仅 提 供 有 限 的 计算 处 
理 。 显 然 ， 在 扩展 语言 中 ， 其 基础 语言 的 全 部 能 力 都 
可 以 用 来 定义 任务 。 

所 有 语言 支持 任务 间 简 单 的 串 行 (序列 ) 的 和 


并 发 (并 行 ) 的 时 序 约束 ， 也 支持 超时 设 定 ， 在 等 
待 指定 的 一 段 时 间 后 触发 。 此 外 ，TDL 直接 支持 宽 范 
围 的 时 序 约束 一 一 可 以 在 任务 的 开始 和 结束 之 间 设 定 
约束 (如 ,任务 B 在 任务 A 开始 后 开始 ,或 任务 C 
在 任务 D 开始 后 结束 )， 也 可 以 指定 度量 约束 (如 ， 
任务 B 在 任务 A 结束 10s 后 开始 ,或 任务 C 在 下 午 
1: 00 开始 ) ESL 和 PLEXIL 支持 事件 ( 如 任务 转移 
到 新 状态 时 ) 信 令 ， 可 以 类 似 地 实现 约束 的 表示 类 
型 。 此 外 ，ESL 和 TDL 支持 基于 事件 发 生 的 任务 终 
止 ， 如 当 任 务 A 开始 时 任务 B 终止 。 

在 异常 监测 和 异常 处 理 方面 ， 各 种 语言 有 着 不 同 
的 考虑 。ESL 和 TDL 都 提供 显 式 的 异常 监测 结构 ， 
并 支持 抛 出 异常 和 由 注册 处 理 器 捕获 异常 的 分 层 处 理 
方式 。 这 种 异常 处 理 方式 与 C+ +, Java 和 Lisp 中 使 
用 的 方式 类 似 。ESL 和 TOL 也 支持 清除 过 程 ， 在 任 
务 终 止 时 可 以 调用 。RAP 和 PLEXIL 并 没有 分 层 异 常 
处 理 机 制 ， 而 是 使 用 返回 值 来 指示 失败 。 但 PLEXIL 
支持 清除 过 程 ， 当 任务 失败 时 运行 该 过 程 。PRS 支持 
执行 监测 ， 但 不 支持 异常 处 理 。ESL 和 PRS 支持 资源 
共享 ， 并 都 对 自动 阻止 任务 间 到 资源 的 连接 提供 支 
持 。 在 其 他 执行 语言 中 ， 这 项 功能 是 需要 分 别 实现 
的 ， 尽 管 有 规划 在 这 方面 扩展 PLEXIL。 

最 后 ，RAP、PRS 和 ESL 均 包含 符号 数据 库 ( 环 
境 模型 ) ， 该 数据 库 或 者 直接 连接 传感器 或 者 连接 行 
为 层 以 保持 与 真实 环境 的 同步 。 通 过 数据 库 查询 可 以 
确定 前 提 条 件 是 否 为 真 、 哪 种 方法 可 用 等 。PLEXIL 
使 用 查找 表 实 现 类 似 的 功能 ,不 过 它 的 实现 方式 
(比如 ， 是 通过 数据 库 查 找 还 是 通过 调用 行为 层 函 
数 ) 对 任务 是 透明 的 。TDL 则 将 这 项 工作 留 给 了 程 
序 员 ， 由 程序 员 来 确定 这 些 任务 如 何 与 环境 进行 
关联 。 

8.3.4 规划 


分 层 结构 中 的 规划 组 件 负责 根据 高 级 目标 确定 机 
器 人 的 长 远 活 动 计划 。 行为 控制 组 件 关 注 的 是 眼皮 底 
下 的 事 儿 ， 执 行 组 件 关 注 的 是 刚刚 发 生 的 和 即将 发 生 
的 事 儿 ， 而 规划 组 件 则 是 面向 未 来 的 。 在 办 公 室 投 递 
机 需 人 的 实例 中 ， 规 划 组 件 要 考虑 一 天 的 投递 、 机 需 
人 的 资源 、 地 图 、 确 定 最 优 投递 路 线 和 调度 ， 包 括 机 
器 人 什么 时 候 应 该 充电 。 当 情境 改变 时 ， 规 划 组 件 也 
负责 重新 规划 。 例 如 ， 如 果 赶 上 办 公 室 锁 门 ， 规 划 组 
件 将 确定 一 个 新 的 投递 计划 ， 而 将 锁 门 办 公 室 的 投递 
任务 安排 到 当天 稍 晚 些 时 候 。 

1. 规划 类 型 
第 9 章 将 详细 描述 机 器 人 规划 的 方法 ， 本 章 概 述 
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与 规划 器 不 同类 型 有 关 的 一 些 问题 ， 
层 结构 有 关 。 

最 常用 的 两 种 方法 是 分 层 任务 网 (HTN) 规划 
器 和 规划 器 /调度 器 。HTN 规划 器 中 ?253 将 任务 分 解 
成 子 任务 ， 其 分 解 方式 与 执行 层 类 似 。 主 要 的 不 同 
是 ，HTN 规划 器 总 是 在 较 高 的 抽象 级 别 进行 操作 、 
会 考虑 到 资源 的 利用 且 具 有 处 理 任务 间 冲 突 的 方法 ， 
如 ， 多 个 任务 需要 相同 的 资源 ,或 者 一 个 任务 否定 了 
男 一 个 任务 所 需 的 前 提 条 件 。HTN 规划 器 所 需 的 知识 
通常 相当 容易 确定 ， 因 为 它 直接 指明 任务 如 何 完 成 。 

规划 器 /调度 器 "下 在 时 间 和 资源 有 限 的 领域 
很 用。 它们 创建 高 级 规划 ， 在 任务 应 该 发 生 时 进行 
调度 ， 但 通常 留 给 执行 层 去 确定 具体 如 何 实现 任务 。 
规划 器 /调度 器 的 工作 通常 是 将 任务 布置 在 时 间 线 上 ， 
对 机 器 人 上 可 用 的 各 种 资源 (如 马达 、 电 力 、 通 信 
等 ) 分 别 采 用 不 同 的 时 间 线 。 规 划 器 /调度 器 所 需 的 
知识 包括 任务 要 完成 的 目标 、 所 需 的 资源 、 持 续 时 间 
和 任务 间 的 约束 。 


因为 它们 都 与 分 


立即 重新 规划 。 在 这 种 方法 中 ， 规 划 组 件 始终 运行 ， 
并 一 直 进 行 着 规划 、 重 规划 。 信 和 号 必须 在 规划 器 和 执 
行 组 件 之 间 实 时 传递 以 使 它们 保证 同步 。 如 3T 
等 体系 结构 采用 的 就 是 第 二 种 方法 。 第 一 种 方法 在 系 
统 处 于 相对 静态 的 环境 时 适用 ， 规 划 次 数 很 少 ， 相 对 
可 预期 。 第 二 种 方法 更 适用 于 动态 环境 ， 重 规划 很 频 
繁 有 旦 难以 预期 。 

在 规划 与 执行 集成 时 还 需要 做 的 决策 是 到 何 时 停 
止 任务 分 解 、 在 何 处 监测 规划 执行 以 及 如 何 处 理 蜡 
常 。 如 果 一 直 规 划 到 基本 动作 或 行为 ， 规 划 器 对 于 执 
行 期 间 将 会 发 生 什么 会 有 很 好 把 握 ， 但 这 是 以 更 多 的 
计算 为 代价 的 。 再 有 ， 有 些 任务 分 解 很 容易 进行 过 程 
描述 (采用 执行 语言 )， 而 非 声明 描述 (采用 规划 语 
言 )。 同 样 ， 执 行 层 的 监测 效率 更 高 些 ， 因 为 监测 点 
靠近 机 器 人 的 传感器 ， 而 规划 器 可 能 会 利用 更 多 的 全 
局 知识 更 早 和 (R) 更 精确 地 检测 到 异常 。 关 于 处 
理 异 常 ， 执 行 层 自己 能 够 处 理 很 多 异常 ， 其 代价 只 是 
破坏 了 规划 器 在 调度 任务 时 的 预期 结果 ， 而 另 一 方 


很 多 体系 结构 提供 专门 的 规划 专家 系统 ， 能 高 效 
地 求解 特定 的 问题 ， 特 别 地 ， 还 包括 运动 规划 器 ， 如 
路 径 规 划 器 和 轨迹 规划 器 。 有 时 ， 体 系 结构 的 规划 层 
直接 调用 这 些 专 门 的 规划 器 ， 而 在 其 他 体系 结构 模式 
中 ， 运动 规 划 器 是 体系 结构 中 较 低层 (执行 层 甚至 
行为 层 ) 的 一 部 分 。 把 这 些 专门 的 规划 器 放 在 哪儿 
通常 属于 选 型 问题 或 者 性 能 问题 (参见 8.5 节 ) 。 

此 外 ， 有 些 体系 结构 提供 多 个 规划 展 呈 ?7 
通常 ， 最 顶层 有 一 个 使 命 规划 层 ， 它 在 很 抽象 的 层 
上 对 相对 较 长 的 一 段 时 间 进 行规 划 。 这 层 主要 负责 选 
择 在 下 一 段 时 间 内 要 实现 哪个 高 级 目标 (并且 有 时 
需要 确定 按 什么 顺序 实现 这 些 目标 ) ， 以 最 大 化 某 个 
目标 函数 ， 如 净 僵 利 。 稍 低 一 些 的 任务 规划 层 负 责 确 
定 怎样 和 何 时 完成 每 个 目标 。 这 样 细 分 通常 是 出 于 对 
效率 的 考虑 ， 因 为 同时 进行 既 长 期 又 细致 的 规划 是 很 
困难 的 。 

2. 规划 与 执行 的 集成 

在 机 器 人 体系 结构 中 将 规划 与 执行 组 件 集成 到 一 
起 有 两 种 主要 方法 。 一 种 方法 是 规划 组 件 由 执行 组 件 
按 需 调用 ， 并 返回 一 个 规划 ， 然 后 规划 组 件 进 入 休 眼 
状态 ， 直 到 再 次 被 调用 。ATLANTIS MI 和 遥控 
Agent ^ 等 体系 结构 都 使 用 这 种 方法 ， 这 要 求 执行 
组 件 要 么 给 规划 组 件 留 下 足够 的 时 间 完 成 规划 ， 要 么 
在 规划 完成 前 对 系统 的 安全 负责 。 例如， 在 遥控 A- 
gent 中 ， 会 显 式 调度 一 个 专门 的 规划 任务 。 第 二 种 方 
法 是 规划 组 件 根 据 需 要 将 高 级 任务 向 下 发 送 到 执行 组 
件 ， 并 监测 这 些 任务 的 进展 情况 。 如 果 任 务 失 败 ， 则 
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面 ， 若 由 规划 器 处 理 异 常 通常 会 涉及 到 重 规划 ， 其 计 
算 代 价 是 高 昂 的 。 

然而 ， 对 于 所 有 这 些 集成 问题 通常 有 一 种 折 中 方 
案 。 例 如 ， 可 以 只 将 某 一 部 分 任务 进行 更 深层 次 的 分 
解 ; 或 者 一 部 分 异常 放 在 执行 层 处 理 ， 而 另 一 部 分 异 
常 交 由 规划 器 处 理 。 一 般 来 讲 ， 恰 当 的 方法 都 需要 折 
中 考虑 ， 并 需要 具体 问题 具体 分 析 (参见 8.5 35), 


8.4 案例 研究 一 -GRACE 


本 节 介 绍 一 个 相当 复杂 的 自主 移动 机 器 人 的 体系 
结构 。 机 器 人 GRACE (Graduate Robot Attending Con- 
ference， 出 席 会 议 的 研究 生机 器 人 ) 是 5 家 研究 机 构 
( 卡 内 基 梅 隆 大 学 、 海 军 研究 实验 室 、 西 北大 学 、 
Metrica 公司 和 Swarthmore 学 院 ) 共同 努力 的 成 果 ， 
设计 用 于 参加 AAAI (美国 人 工 智能 学 会 ) 的 机 器 人 
挑战 赛 。 挑 战 赛 要 求 机 器 人 作为 与 会 者 参加 AAAI 举 
办 的 全 国人 工 智 能 大 会 ， 机 器 人 必须 要 找到 注册 台 
(预先 不 知道 会 议 中 心 的 布置 ) ， 并 注册 会 议 ， 然 后 
根据 会 议 提 供 的 地 图 找到 路 线 并 及 时 到 达 指 定 地 点 进 
行 技术 交流 。 

在 给 定 了 任务 的 复杂 性 和 技术 集成 的 需求 后 ， 机 
器 人 的 体系 结构 设计 尤为 重要 。 这 些 技术 已 由 上 述 5 
家 机 构 先 期 开发 过 ， 包 括 动态 环境 中 的 定位 、 在 行人 
面前 的 安全 导航 、 路 径 规划 、 动 态 重 规划 、 人 体 视 觉 
跟踪 、 告 示 牌 、 标 记 、 手 势 和 人 脸 的 识别 、 语 音 识 别 
与 自然 语言 理解 、 语 音 合成 、 知 识 表示 以 及 与 人 社交 
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等 技术 。 

GRACE 以 RWI (Real World Interface ) O 的 B21 
机 器 人 为 基础 ， 配 有 一 个 由 平板 液晶 显示 器 (LCD) 
显示 的 表情 丰富 的 计算 机 动画 人 脸 (如 图 8.9 所 
AR). B21 上 配备 触觉 、 红 外 和 声 纳 等 传感器 ， 最 靠 
近 底 座 的 是 一 个 SICK 激光 扫描 测 距 仪 ,具有 180 EE 
的 视野 。 此 外 ，GRACE 还 装配 了 几 台 摄像 机 ， 包 括 
一 台 由 Metrica TRACLabs 制造 的 云 台 立体 摄像 机 、 一 
@ Canon 产 的 云 台 变焦 单 色 摄像 机 。GCRACE 借助 高 
品质 语音 合成 软件 Festival 讲话 ， 使 用 无 线 耳 麦 


(Shure TC 的 计算 机 无 线 收发 套件 ) 接收 语音 信息 。 
— 


图 8.9 机 器 人 GRACE 


行为 层 


GRACE 体系 结构 的 行为 层 由 一 些 控 制 特定 硬件 
部 件 的 独立 进程 构成 ， 这 些 程序 提供 抽象 接口 ， 或 用 
于 硬件 控制 ， 或 用 于 从 传感器 返回 信息 。 为 了 使 用 各 
种 设备 不 同 的 编码 类 型 ， 大 部 分 接口 既 支持 同步 的 、 
阻塞 的 调用 ， 也 支持 异步 的 、 非 阻塞 的 调用 (对 于 
非 阻塞 调用 ， 接 口 允 许 程 序 员 指定 数据 返回 时 的 回调 
函数 ) 。 行 为 层 包括 机 器 人 运动 和 定位 (也 提供 激光 
测 距 信息 ) 、 语 音 识别 、 语 音 合成 、 面 部 动画 、 彩 色 
视觉 与 立体 视觉 (如 图 8.10 所 示 ) 等 接口 。 
该 体系 结构 中 对 执行 层 的 每 项 能 力 都 采用 独立 
的 进程 实现 ， 这 么 做 主要 是 由 于 底层 代码 都 是 由 不 
同 公司 开发 的 ， 尽 管 让 大 量 进 程 并 发 运行 可 能 会 效 
率 很 低 ， 但 要 想 把 所 有 功能 都 放 在 单个 进程 中 完成 ， 
则 实在 太 难 。 此 外 ， 使 用 分 离 的 进程 还 便于 开发 和 
调试 ， 因 为 每 次 只 需要 与 系统 中 需要 测试 的 部 分 打 
交道 。 

执行 层 由 完成 挑战 赛 每 个 子 任务 的 独立 程序 构 
成 ， 包 括 寻找 注册 台 、 乘 电梯 、 排 队 、 与 注册 人 员 交 
流 、 走 到 报告 区 和 作 报 告 ， 如 图 8. 10 所 示 。 与 很 多 
已 实现 的 机 器 人 系统 一 样 ，GRACE 体系 结构 没有 规 
划 层 ， 因 为 这 里 涉及 的 高 级 规划 任务 要 么 是 一 成 不 变 
的 ， 要 么 是 很 简单 易 行 的 ， 直 接 编程 即 可 。 有 些 执行 
层 程序 采用 TDL (参见 8.3.3 W) 写成 ,这样 便于 并 
发 控制 和 各 种 任务 的 监测 。 


aasre | | rae 
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图 8. 10 GRACE 的 体系 结构 


O VATE: RWI 目前 是 iRobot 公司 的 一 个 分 部 。 
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机 器 人 学 基础 


寻找 注册 台 是 必 不 可 少 的 一 项 任务 (前 已 述 及 ， 
GRACE 并 不 知道 注册 台 在 哪儿 ， 也 不 知道 会 议 中 心 
长 什么 样 )。GRACE 采用 TDL 构造 了 有 限 状 态 机 ， 
这 样 它 就 可 以 维护 多 个 目标 ， 如 利用 电梯 到 达 某 一 楼 


从 以 前 开发 的 系统 中 移植 过 来 的 (也 就 是 说 已 经 过 
很 好 的 测试 ) 。 而 执行 层 的 进程 在 非 标 称 情境 下 则 
出 了 不 少 问题 。 问 题 主要 出 在 传 感 数据 的 理解 上 以 
及 对 会 议 中 心 看 起 来 会 是 什么 样 的 错误 假定 ， 例 如 ， 


层 、 按 照 指南 找到 电梯 (如 图 8.11 所 示 )， 最 顶级 
的 目标 是 找到 注册 台 。 当 GRACE 与 人 交互 拿 到 了 去 
注册 台 的 指南 时 ， 一 些 中 间 目 标 就 创建 出 来 了 。 如 果 
没有 指南 可 用 ，GRACE 就 随机 和 逛 一 逛 ， 直 到 用 激光 
扫描 仪 探测 到 人 ， 它 便 会 和 人 交流 以 得 到 指南 。 
GRACE 可 以 处 理 简 单 的 命令 ， 如 左 转 、 向 前 Sm， 也 
能 处 理 一 些 高 级 指令 ， 如 乘 电梯 、 下 一 路 口 左 转 。 此 
外 ，GRACE 还 会 提问 ， 如 “我 这 是 走 到 注册 台 了 
吗 ?”、“ 这 是 电梯 吗 ?” GRACE 在 各 个 时 刻 都 使 用 基 


F TDL 的 有 限 状态 机 来 确定 如 何 交 互 最 恰当 ， 这 样 
可 以 防止 “思维 ”混乱 。 
目的 地 


7 
目的 地 监测 


图 8.11 GRACE 按照 指南 走 到 注册 台 的 有 限 状 态 机 


进程 间 通 信 采 用 IPC 消息 包 “ * 77 , IPC 支持 发 
布 / 订 阅 和 客户 机 /服务 器 两 种 消息 机 制 ， 能 在 进程 
间 透 明 传递 复杂 的 数据 结构 。 使 用 IPC 进行 进程 间 
通信 的 一 个 好 处 是 能 够 记录 下 所 有 的 消息 通信 信息 ， 
既 能 记录 消息 名 称 ， 也 能 记录 数据 内 容 。 事 实证 明 ， 
有 时 要 弄 清 楚 系 统 为 什么 没 能 按照 预期 动作 执行 ， 
非 这 些 记 录 不 可 。 是 进程 发 送 了 无 效 数 据 ? 还 是 没 


有 些 隔断 是 玻璃 的 ， 而 激光 传感器 几乎 检测 不 到 。 
不 过 总 而 言 之 ， 该 体系 结构 还 是 不 负 众 望 ， 把 一 大 
堆 复 杂 的 软件 相当 快 地 集成 起 来 并 能 高 效 地 一 起 


运行 。 
8.5 机 器 人 体系 结构 设计 艺术 


设计 机 器 人 体系 结构 说 是 科学 ， 但 更 是 艺术 。 
体系 结构 设计 的 目标 是 使 得 编程 实现 一 个 机 器 人 更 
容易 、 更 安全 、 更 灵活 。 因 而 ， 一 个 机 器 人 体系 结 
构 开 发 者 所 做 的 决策 会 受到 其 个 人 经 验 (如 熟悉 哪 
些 程序 设计 语言 ) 、 机 器 人 与 环境 以 及 要 执行 的 任 
务 等 多 方面 影响 。 体 系 结构 的 选 型 不 可 轻视 ， 因 为 
根据 创造 者 的 经 验 ， 一 且 选 定 体系 结构 ， 那 就 是 多 
少年 都 不 动 播 的 。 改 变 机 器 人 的 体系 结构 是 个 难题 ， 
且 当 大 量 代 码 已 经 实现 时 再 改 体系 结构 会 使 开发 进 
度 倒 退 。 

机 器 人 体系 结构 设计 艺术 始 于 设计 者 要 问 的 一 系 
列 问题 ， 这 些 问题 包括 ; 

@ 机 器 人 要 执行 什么 任务 ? 是 长 期 任务 还 是 短 
期 任务 ? 是 用 户 发 起 的 还 是 机 器 人 发 起 的 ? 任务 是 重 
复 性 的 还 是 随 着 时 间 总 在 变化 的 ? 

e 执行 任务 需要 哪些 动作 ? 那些 动作 如 何 表示 ? 
动作 之 间 如 何 协 调 ? 执行 时 需要 用 多 快 的 速度 选择 和 
改变 动作 ? 为 了 保证 机 器 人 安全 ， 每 个 动作 以 什么 样 
的 速度 执行 ? 

e 任务 需要 处 理 什 么 数据 ? 机 器 人 如 何 从 环境 
或 者 用 户 获取 数据 ? 用 什么 传感器 来 获取 这 些 数据 ? 
数据 如 何 表示 ? 用 什么 处 理 方法 将 传感器 数据 抽象 成 
体系 结构 内 部 表示 ? 数据 所 需 的 更 新 频率 如 何 ?数据 
能 够 更 新 的 频率 又 如 何 ? 

e 机 器 人 需要 什么 样 的 计算 能 力 ? 这 些 计 算 能 
力 要 输出 什么 样 的 数据 ， 又 要 输入 什么 样 的 数据 ? 机 
器 人 的 这 些 计算 能 力 如 何 进 行 划 分 和 结构 化 处 理 ， 又 
如 何 互 连 ? 计算 能 力 的 最 佳 分 解 〈 粒 度 ) 是 什么 ? 


有 及 时 发 出 消息 ?是 接收 进程 因 故 阻塞 了 ? 还 是 时 
间 上 的 问题 ? 尽管 分 析 这 些 消息 日 志 往 往 令 人 乏味 ， 
但 某 些 时 候 这 也 是 找到 那些 间 钦 性 故障 的 唯一 手段 。 

2002 年 7 H, GRACE 成 功 地 完成 了 在 加 拿 大 埃 
德 蒙 顿 的 Shaw 会 议 中 心 的 挑战 。 行 为 层 的 进程 总 的 
来 说 是 如 预期 那样 工作 的 ， 这 要 归功 于 这 些 模块 都 是 


每 项 计算 能 力 要 对 其 他 计算 能 力 知晓 多 少 ” 有 可 重用 
(来 自 其 他 机 器 人 或 者 其 他 项 目 等 ) 的 计算 能 力 吗 ? 
不 同 的 计算 能 力 驻 留 在 何 处 〈 如 板 载 或 者 板 外 )? 

e 机 器 人 的 用 户 是 什么 人 ? 他 们 要 用 机 器 人 做 
什么 ?他 们 需要 对 机 器 人 的 计算 能 力 有 什么 样 的 理 
fito 用户 怎么 了 解 机 咒 人 在 做 什么 ? 用 户 的 交互 是 对 
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等 的 、 监 管 的 还 是 旁观 性 质 的 ? 

e 如 何 评 价 这 个 机 器 人 ? 成 功 的 标准 是 什么 ? 
失败 的 模式 又 有 哪些 ?” 如 何 规避 失败 ? 

@ 用 一 种 机 器 人 的 体系 结构 处 理 不 止 一 套 任 务 ? 
还 是 用 不 止 一 种 机 器 人 去 处 理 ? 需要 不 止 一 班 开 发 人 
马 吗 ? 

一 县 设计 者 对 所 有 (或 大 部 分 ) 问题 有 了 答案 ， 
便 可 以 开始 针对 想 让 机 器 人 执行 的 操作 的 类 型 和 想 让 
用 户 如 何 与 之 交互 的 方式 设计 一 些 用 例 。 这 些 用 例 应 
该 详细 说 明 机 器 人 与 环境 和 用 户 有 关 的 外 部 行为 。 从 
这 些 用 例 ， 可 以 逐步 开始 机 器 人 功能 的 初始 划分 。 划 
分 的 同时 应 该 画 出 序列 图 ， 以 便 显 示 信 息 和 控制 流 随 
着 时 间 推 移 在 机 器 人 体系 结构 各 种 组 件 间 的 传递 情 
WS, WJA, MARENE ERK R A 
间 的 接口 规格 说 明 。 这 项 工作 可 以 借助 诸如 CORBA 
的 IDL (接口 定义 语言 ) 这 样 的 语言 来 完成 ， 也 可 以 
采用 发 布 /订阅 协议 定义 要 分 发 的 消息 来 完成 。 这 是 
至 关 重 要 的 一 步 ， 因 为 一 旦 开始 实施 再 想 更 改 ， 代 价 
可 就 大 了 。 如 果 接 口 要 修改 ， 就 要 通知 到 所 有 用 此 接 
口 的 组 件 与 改 后 接口 的 保持 一 致 。 机 器 人 体系 结构 集 
成 时 最 常见 的 问题 是 组 件 预期 的 数据 与 其 正在 收 到 数 
据 不 匹配 。 

接口 定义 清晰 的 分 层 体 系 结构 有 个 好 处 就 是 各 层 
可 以 并 行 开 发 。 行 为 控制 层 拿 人 当成 执行 层 就 可 以 开 
始 在 机 器 人 上 实现 和 测试 了 。 执 行 层 采用 状态 机 桩 虽 
模拟 机 器 人 上 的 预期 行为 就 可 以 开始 实现 和 测试 了 。 
这 些 桩 仅仅 是 响应 调用 适时 地 答 个 到 而 已 。 然 后 ， 各 
层 就 可 以 集成 测试 时 序 和 其 他 运行 时 问题 了 。 只 有 在 
组 件 的 角色 和 接口 都 被 定义 和 考虑 清楚 的 情况 下 ， 这 
种 并 行 方法 才能 加 速 机 器 人 体系 结构 的 开发 进程 。 做 
集成 时 ， 实 时 调试 问题 也 需要 考虑 。 根 据 我 们 的 经 
验 ， 机 器 人 体系 结构 的 大 部 分 开发 时 间 还 是 花 在 行为 
控制 层 ， 也 就 是 说 ， 与 执行 和 规划 相 比 ， 感 知 和 行动 
依然 是 机 器 人 的 “硬件 ”。 做 出 一 个 良好 的 、 和 鲁 棒 的 
行为 控制 屋 ， 就 等 于 向 合格 的 机 器 人 体系 结构 迈 出 了 
CUN 


8.6 结论 与 扩展 阅读 


设计 机 器 人 体系 结构 有 助 于 使 完成 任务 的 行为 并 


O Pu: 状态 机 桩 就 是 一 种 模拟 的 状态 机 的 函数 。 


发 执行 ， 能 让 机 器 人 系统 控制 执行 器 、 解 译 传 感 器 、 
规划 、 监 测 执行 并 处 理 意外 事件 和 把 握 良 机 。 体 系 结 
构 给 出 了 领域 相关 的 软件 开发 的 概念 框架 ， 还 常常 提 
供 一 些 编程 工具 以 便于 开发 软件 。 

然而 ， 没 有 万 能 的 体系 结构 。 研 究 人 员 已 经 开 
发 了 各 种 各 样 的 体系 结构 可 用 于 不 同 的 应 用 场合 ， 
但 还 没有 明确 的 规则 能 确定 在 给 定 应 用 场合 下 选 哪 
种 体系 结构 最 适用 ， 本 章 给 出 了 一 些 指导 方针 以 助 
于 开发 人 员 在 工作 中 选择 恰当 的 体系 结构 。 可 以 
说 ， 分 层 体系 结构 已 经 越 来 越 普及 ， 这 要 归功 于 
他 们 的 灵活 性 及 其 在 多 个 抽象 级 别 上 同时 操作 的 
能 力 。 

(AI and Mobile Robots) ”一 书 中 有 若干 关于 体 
系 结构 的 章节 (本 章 参 考 了 不 少 ) 。 大 多 数 机 器 人 教 
BES 9991 中 都 有 机 器 人 体系 结构 的 章节 。20 世纪 
90 年 代 中 期 ，AAAI 举办 的 人 工 智 能 春季 研讨 会 上 连 
续 几 年 都 有 机 器 人 体系 结构 议题 ， 但 该 研讨 会 的 论文 
集 并 未 广泛 发 行 。 关 于 GRACE 的 更 多 信息 可 以 查阅 
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人 工 智 能 (AD 推理 技术 涉及 推理 、 规 划 和 
学 习 ， 已 有 大 量 成 功 应 用 的 记录 。 那 么 ， 它 能 作为 
自主 移动 机 器 人 的 方法 工具 箱 吗 ? 未 必 ! 因为 移动 
机 融 人 关于 动态 的 、 部 分 可 知 的 环境 的 推理 与 基于 
知识 的 纯 软 件 系统 (其 中 多 数 著名 成 果 已 记录 在 
R) 中 的 推理 可 能 有 着 本 质 的 不 同 。 

本 章 主 要 探讨 基于 符号 的 人 工 智 能 推理 中 与 机 
器 人 有 关 的 内 容 。 先 一 般 性 介绍 知识 表示 与 推理 的 
基本 方法 ,包括 基 于 逻辑 的 方法 和 基于 概率 的 方 
法 。 然 后 专门 探讨 与 机 器 人 有 关 的 一 些 特殊 问题 ， 
包括 基于 逻辑 的 高 级 机 融 人 控制 、 模 糊 逻 辑 以 及 时 
间 约 束 推理 的 问题 。 最 后 ， 详 细 介 绍 推 理 的 两 种 一 
般 性 应 用 一 一 动作 规划 和 学 习 。 

一 般 性 的 推理 目前 还 不 是 自主 移动 机 器 人 配备 
的 标准 功能 。 本 章 除了 介绍 与 机 器 人 有 关 的 人 工 智 
能 推理 的 研究 现状 外 ， 还 会 指出 为 实现 机 器 人 智能 
推理 而 有 待 进一步 研究 解决 的 问题 。 

本 章 首先 在 9. 1 节 总 体 上 回顾 一 下 知识 表示 和 
演绎 推理 ， 然 后 在 9. 2 节 较 为 详细 地 探讨 专门 考虑 
机 需 人 相关 应 用 的 推理 问题 。 介 绍 完 推 理 的 方法 后 ， 
再 介绍 推理 的 一 般 性 应 用 ， 即 9. 3 TrBgs EU ft 


尽管 关于 移动 机 咒 人 中 使 用 符号 推理 的 必要 性 


和 明智 性 有 过 争论 ， 但 目前 在 机 器 人 的 控制 系统 的 


某 个 部 分 或 某 层 中 应 该 或 者 可 以 包含 推理 


1 


分 并 保证 控制 周 


这 一 点 上 
以 乎 达成 了 共识 。 将 推理 功能 融入 控制 器 的 其 他 部 
期 时 间 足 够 短 〈 以 使 机 器 人 能 在 动 


态 环境 中 安全 地 行动 ) 是 个 难题 ， 混 合 控制 体系 结 
构 (参见 第 8 章 ) 将 成 为 解决 这 个 难题 的 典型 软件 


结构 。 


的 含义 来 理解 的 ， 即 基于 符号 的 慎 思 ， 如 一 阶 谓 词 逻 
c (FOPL) 或 贝 叶 


符号 推理 在 这 里 是 按照 经 由 人 工 智能 (AI) 中 


斯 概率 理论 ， 但 其 中 通常 有 些 限 


ii 


制 或 扩展 ， 并 需 


在 表达 能 力 与 推理 速度 之 间 进 行 权 


衡 ， 以 求 二 者 的 最 佳 组 合 。 


O Hei: 即 符号 与 真实 对 象 之 间 的 对 应 关系 问题 。 
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9. 


推 
的 


或 


描 
涉 


Ps 


AE 


于 这 种 明确 的 


1 知识 表示 与 推理 


推理 时 要 求 推理 器 〈 这 里 就 是 指 机 器 人 ) 对 要 
理 的 环境 的 某 些 部 分 〈 或 某 些 方面 ) 有 一 个 明确 
表示 ， 这 就 立即 引出 两 个 问题 : 什么 样 的 格式 适用 
RIN? 要 表示 的 知识 来 自 哪里 ? 

第 二 个 问题 是 指 基于 先前 的 符号 描述 和 从 传感器 
与 其 他 Agent 通信 获取 的 环境 信息 对 机 器 人 的 环境 


至 少 是 环境 的 一 部 分 ) 实时 地 生成 并 维护 一 种 符号 


述 的 问题 。 总 的 来 说 ， 这 个 问题 迄今 尚未 解决 。 它 
及 人 工 智能 的 基础 理论 ， 如 符号 接地 [0 和 对 象 错 
p31 问 题 83 ， 因 此 ， 机 器 人 中 实际 的 符号 推理 仅 限 
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于 能 被 保持 到 最 近 的 那 部 分 知识 。 显 然 ， 这 包括 关 
于 环境 的 静态 知识 ( 如 建筑 物 中 的 拓扑 环境 及 其 相 
互 关系 )、 符 号 表 中 可 用 的 临时 知识 (如 设备 管理 
数据 库 中 的 知识 ) 以 及 最 富 挑战 性 的 从 传感器 数据 
中 提取 的 符号 数据 。 通 过 摄像 机 数据 进行 目标 识别 
(参见 第 23 章 ) 就 是 一 个 与 这 里 探讨 的 问题 有 关 的 
方法 。 

本 节 探 讨 第 一 个 问题 的 答案 ， 即 适用 于 知识 表示 
的 形式 化 问题 。 这 里 的 适用 性 必须 同时 考虑 到 两 个 方 
面 〈 恰 如 硬币 的 两 个 面 ) : 一 方面 是 认 知 适用 性 一 一 
这 种 形式 能 将 环境 的 目标 侧面 简洁 准确 地 表达 出 来 
"jo 男 一 方面 是 计算 适用 性 一 一 这 种 形式 能 将 典型 的 
推理 结果 切实 高 效 地 推导 出 来 吗 ? 二 者 之 间 需 要 权 
衡 。 很 丰富 、 很 有 表现 力 从 而 在 认识 论 上 很 有 吸引 力 
的 形式 ， 却 往往 伴随 着 难于 处 理 甚 至 逻辑 上 不 可 判定 
的 问题 ， 反 之 亦 然 。 于 是 ， 知 识 表示 (KR) 可 以 定 
位 为 “AI 的 一 个 研究 领域 ， 致 力 于 设计 表示 特定 领 
HAJAR” 。 

本 节 着 力 探讨 两 类 形式 化 方法 ， 即 逻辑 和 概率 理 
论 及 各 自 的 推理 过 程 。 要 想 了 解 关 于 KR 领域 的 介绍 
和 最 近 的 研究 成 果 ， 我 们 推荐 读者 阅读 本 章 后 面 给 出 
的 一 般 性 AL 和 KR 文献 。 此 外 ， 还 有 个 知识 表示 国 
际会 议 
sentation (KR) ， 两 年 一 次 ， 每 逢 偶数 年 召开 。 


9.1.1 逻辑 


一 阶 谓词 逻辑 (FOPL) 是 AI 领域 中 知识 表示 形 
式 化 方法 的 原型 。 但 必须 得 说 明 ， 它 并 不 能 同时 满足 
前 已 述 及 的 可 认 知 性 和 可 计算 性 要 求 ， 在 很 多 情况 
下 ， 甚 至 两 个 都 不 能 满足 。 然 而 ， 它 是 从 概念 上 和 数 
学 上 理解 用 确定 知识 进行 表示 和 推理 的 形式 化 方法 的 
基础 。 

这 里 假定 读者 都 已 了 解 FOPL 的 基本 概念 ， 不 再 
费 述 ， 大 家 可 以 参阅 众多 的 AI 教材 和 介绍 。 每 一 部 
经 典 AI 教材 都 会 介绍 FOPL， 参 考 文献 [9.4, 5] Jh 
不 例外 。 参 考 文献 [9.6]. [9.7] 和 [9.8] 分 别 介 
绍 了 逻辑 的 原理 、 应 用 和 数学 方法 。 
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感 数据 ， 感 知 到 办 公 楼 中 的 De 号 门 现在 是 关 着 的 ， 
在 有 些 专门 的 FOPL 语言 中 用 Closed (Do) 表示 ， 假 
定 是 符号 的 直觉 的 解 译 。 进 一 步 假设 机 器 人 关于 办 公 
楼 的 静态 知识 库 包括 以 下 语句 : 

Connects ( Dag , C5 ,Rio ) , 

Connects ( Da , C5 , Rsog ) , 

Connects ( Dog. , Rog , Rso9 ) , 

V dl, ,L, [ Connects( d ,l, ,L,) &*Connects(d ,L, ,1,) ] , 

V d. [ Closed( d) €» Open(d)], 

YL [ At(D) Accessible(1) ] , 

V1, ,L. [Accessible (l ) —( dd. [ Connects(d, l, 
L) ^ Open(d) |—Accessible(l,) ) ] 

常量 D, 和 变量 d ZANT], R 表示 房间 ，C; 表示 
走廊 ， 变 量 1 和 7, 表示 位 置 ， 即 房间 和 走廊 。 假 定 机 
器 人 的 定位 系统 告诉 它 当前 房间 或 走廊 的 位 置 就 用 
At( + )o 

那么 ,假定 机 器 人 知道 它 自己 ACC), WEF 
Closed (Do) 意味 着 - Open( Dw), EARE, (X 
“4 Open( Dogg) ^ Open (Das) 为 真 时 才 有 Accessible 
(Rs ) ， 这 样 ， 比 如 执行 一 项 到 Rso, 房间 的 投递 任务 ， 
机 器 人 可 以 重 规划 经 过 Roo 的 路 线 ， 除 非 已 知 Dsos 和 
Dsoss 中 至 少 有 一 扇 是 关 着 的 ， 如 果 其 中 一 扇 或 两 扇 的 
状态 都 不 知道 (根据 当前 的 知识 库 ， 就 意味 着 既 不 
是 Open( * ) 也 不 是 Closed( * )。 那 么 ，Rsw 的 可 达 
性 既 不 能 被 证 明 为 可 行 也 不 能 被 证 明 为 不 可 行 ， 于 是 
规划 通过 Dsos 和 Dsos, 将 作为 可 选项 保留 ， 同 时 现场 收 
集 它 们 必要 的 状态 信息 。 

如 这 个 小 例子 所 示 ，FOPL 是 一 个 有 力 的 表示 与 
推理 工具 ， 而 且 ， 其 理论 也 易于 理解 。 不 过 ， 众 所 
周知 FOPL 中 的 结果 一 般 是 不 可 判定 的 ， 这 就 意味 

一 个 可 靠 的 、 完 备 的 演绎 算法 在 一 些 特定 推理 情 

况 下 甚至 不 能 保证 终止 ， 就 更 不 用 说 迅速 得 出 结 
ARI. 

然而 ， 这 并 不 意味 着 逻辑 就 完全 不 能 作为 表示 
和 推理 的 工具 。 很 多 应 用 并 不 需要 FOPL 完全 的 表 
达 性 ， 此 外 ， 有 很 多 有 趣 的 FOPL 语言 子 集 是 可 判 
定 的 ， 并 在 很 多 实际 情况 中 可 由 算法 高 效 地 处 理 。 


在 逻辑 系统 中 ， 对 知识 进行 形式 化 表示 便于 从 该 


ARE 
算 进 行 推理 ) 。 自 动 演绎 是 逻辑 和 AI 的 一 个 分 支 领 
域 ， 已 经 实现 了 大 量 很 有 力 的 演绎 系统 可 供 使 用 
(参见 参考 文献 [9.4] 第 9 章 的 介绍 ,参考 文献 
[9.9] 是 较 新 的 、 综 合 性 的 汇编 ) 。 

依靠 逻辑 推理 ， 机 器 人 能 推断 出 大 量 很 难 或 不 可 
能 获取 的 事实 。 例 如 ， 假 定 机 器 人 通过 获取 和 和解 译 传 


于 是 ,为 了 更 广泛 的 应 用 ，KR 研究 人 员 一 直 在 努 
力 寻 找 FOPL 子 集 及 适用 的 推理 过 程 ， 可 以 胜任 可 


认 知 性 和 可 计算 性 需求 。 下 面 详细 探讨 其 中 的 命题 
逻辑 和 描述 逻辑 。 


1. 命题 系统 

在 相当 多 的 实际 情况 中 ，FOPL 理论 (公式 集 ) 
实际 表示 有 限 域 。 从 逻辑 上 讲 ， 它 们 具有 有 限 的 海 伯 
伦 域 ， 或 至 少 能 改写 成 具有 有 限 海 伯 伦 域 的 形式 。 在 
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这 种 情况 下 ， 用 FOPL 语法 表示 域 理 论 可 能 依然 是 最 
得 心 应 手 的 。 但 所 有 超越 纯 命题 系统 的 表示 仅仅 是 为 
了 符号 上 的 方便 。 例 如 ， 一 条 陈述 机 器 人 在 一 个 时 刻 
只 能 处 于 一 个 位 置 (房间 或 走廊 ) 的 公理 : 
V1, 1. [Ai(1,) (8 AQ) V. 1, 205)] 
对 于 有 限 的 建筑 物 ， 可 以 展开 为 一 种 兄长 但 却 等 价 的 
形式 ， 这 种 形式 可 以 明确 地 处 理 所 有 位 置 。 例 如 ， 在 
一 个 六 层 楼 中 ; 
At( Ry, ) > La At (Ro) ^ a At (Ros) 和 和 
At(R54) A 7 At(C,) ^9 At(Cy,) ^s ^ 8 ACQQCS$) ], 
At (Ry ) > [a At ( Roi) Aa At (Ro) ^c 
At (R54) ^o At( Cy, An At( Cs) ^o At( Cs) ] , 


其 中 ,一 个 谓词 (如 上 面 的 41) 的 每 一 个 自由 变 元 
都 取 值 后 ， 字 面 上 即 被 看 作 命题 变量 。 

这 里 有 个 好 消息 ，FOPL 理论 在 有 限 海 伯 伦 域 
上 对 应 的 展开 理论 是 命题 性 的 ， 因 此 是 可 判定 的 ， 
而 且 ， 在 一 些 实际 条 件 下 ， 如 FOPL 中 的 变 元 是 很 
清楚 的 〈 即 如 涉及 房间 和 走廊 的 变 元 上 和 的 信 
息 可 用 ) ， 则 可 以 用 更 精简 的 FOPL 语法 机 械 地 
生成 。 

潜在 的 坏 消 息 是 ， 现 在 的 命题 系统 可 以 由 大 量 命 
题 语句 构成 ， 一 般 情 况 下 ， 需 要 生成 所 有 FOPL 语句 
中 的 变 元 置换 的 所 有 组 合 ， 这 会 导致 计算 复杂 度 随 着 
FOPL 变 元 的 域 的 尺寸 呈 指 数 级 增长 。 

不 过 ,命题 可 满足 性 检查 或 模型 检查 技术 正在 
突飞猛进 ， 能 使 有 成 千 上 万 个 变 元 要 处 理 的 命题 系 
统 在 常规 硬件 上 以 秒 级 的 计算 时 间 进 行 处 理 。 当 存 
在 可 满足 性 命题 公式 模型 或 很 多 事实 的 真 假 性 已 知 
时 (如 通过 独立 定位 已 知 机 器 人 41( C;))， 这 些 方 
法 会 特别 有 效 ， 而 这 两 种 都 是 实际 知识 表示 中 常见 
的 情况 。 

参考 文献 [9.4] 第 7 章 介 绍 了 模型 检查 。 有 一 
类 算法 都 是 基于 经 由 的 Davis- Putnam (DPLL) 算 
法 ”中 ， 它 试图 系统 地 构建 一 个 给 定理 论 的 命题 模 
型 ， 有 效 地 传播 变 元 的 解释 约束 。 另 一 类 算法 应 用 局 
部 搜索 技术 ， 试 图 使 用 随机 (Monte Carlo) 变 元 指派 
生成 解释 。 参 考 文献 [9.11] 收录 了 近来 的 论文 并 
总 结 了 研究 现状 ， 其 中 有 一 篇 介绍 SAT2002 竞赛 结 
果 的 论文 ， 详细 讨论 了 最 近 可 满足 性 检查 器 关于 综合 
问题 ( 非 同 一 般 的 难 ) 的 性 能 。 

2. 描述 逻辑 

20 世纪 70 年 代 出 现 了 描述 逻辑 (DL), XÆ AI 
领域 知识 表示 中 的 一 种 严格 的 形式 化 方法 ， 它 包括 语 


义 网 络 和 框架 系统 。 从 逻辑 上 讲 ，DL 有 很 多 变种 ， 
形成 一 类 FOPL 的 可 判定 子 集 。 

使 用 DL 语言 表示 某 特 定 领 域 的 知识 需要 两 个 部 
分 。 首 先 ， 领 域 的 顶层 本 体 要 形式 化 ， 它 引入 一 般 性 
的 领域 概念 及 概念 间 的 关系 。 所 有 本 体 中 有 一 个 特别 
有 趣 的 关系 类 型 是 超 类 - 子 类 关系 。DL ( 某 种 意义 上 
是 强制 可 判定 性 ) 严格 禁止 在 概念 间 设 定 循环 关系 。 
超 类 关系 隐 含 着 概念 上 的 层次 关系 ， 可 以 定义 属性 继 
承 ， 很 多 地 方 类 似 于 面向 对 象 程序 设计 。 由 于 历史 原 
， 基 于 描述 逻辑 的 领域 知识 表示 中 ， 这 第 一 部 分 常 
被 称 作 TBox (或 术语 知识 ) 。 

DL 语言 中 的 概念 与 一 元 谓词 相关 。 举 个 例子 ， 一 
个 机 器 人 导航 领域 的 本 体 可 以 包括 Door, Location 等 
概念 ， 概 念 的 层次 是 通过 定义 概念 相等 ( = ) 或 子 
概念 属性 (如 ，Room Location 和 Corridor C Location ) 
来 建立 的 。 概 念 可 以 用 概念 合 取 、 析 取 和 和 否定 (分 
BUA. Ufa 表示 ) 组 合 而 成 ， 如 ， 可 以 将 概念 
如 此 定义 . Location = Room U Corridor, Door = Closed U 
Open 和 Open = ^ Closed。 

DL 语言 中 的 任务 与 二 元 谓词 对 应 ， 如 引 癌 
(leadsTo) 门 和 某 个 位 置 。 任 务 的 逆 、 交 和 并 可 以 如 
预期 的 一 样 定 义 ， 如 leadsTo = leadsFrom 就 是 定义 
逆 任 务 的 一 例 。 任务 可 以 复合 ， 如 定义 adjacent = 
leadsFrome leadsTo (位 置 1 邻接 m 当日 仅 当 通过 某 个 
门 能 从 1 到 m)。 最 后 ， 概 念 与 任务 可 以 组 合 起 来 定 
义 新 的 概念 和 任务 。 特 别 地 ， 也 可 以 用 量词 限定 任务 
填充 算 子 ， 即 ， 可 以 用 个 体 对 象 (参见 后 面 的 内 容 ) 
连续 蔡 换 任务 参数 ， 例 如 ， 可 以 定义 BlockedLoc = 
LocationN= J leadsFrom. Open ( 假定 了 算 子 的 直觉 绑 
定 规则 ) 。 不 同 的 DL 变种 中 ， 其 他 可 用 的 算 子 有 所 
不 同 ， 详 见 参考 文献 【9.3] 。 

作为 用 DL 表示 领域 知识 的 第 二 部 分 ， 需 要 给 概 
念 和 任务 引入 个 体 对 象 ， 领 域 知识 表示 的 这 一 部 分 称 
fE ABox 或 断言 知识 ， 如 ， 可 以 断言 Room (Row )、 
leadsTo( Da , Ra) 和 Closed( Day) o 

DL 提供 大 量 推理 服务 ， 都 是 基于 已 知 的 TBox 和 
ABox 中 的 逻辑 推理 ， 它 们 包含 概念 定义 的 一 致 性 、 
概念 的 包容 与 分 离 、ABox 关于 TBox 的 一 致 性 以 及 概 
念 与 任务 实例 ,在 DL 中 所 有 这 些 都 是 可 判定 的 。 例 
如 ， 给 定 了 TBox 和 ABox 的 上 述 基本 内 容 ， 就 可 以 推 
断 出 每 一 项 都 是 一 致 的 ， 且 有 BlockedLoc( Rsw) (请 
注意 ， 这 里 只 有 Do 号 门 能 通 向 房间 Ra ) 。 这 些 DL 
推理 在 理论 上 很 难处 理 ， 但 在 很 多 实际 情况 中 运行 效 
率 还 是 很 高 的 。 

参考 文献 [9.3] SÉ 


综述 了 DL 研究 现状 。 
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2004 4E, WWW 联盟 (W3C) 定义 了 Web 本 体 语言 
(OWL)?! ， 作 为 语义 网 络 的 技术 基础 。 该 语言 
有 一 部 分 是 OWL- DL， 从 某 种 意义 上 就 是 前 已 述 及 的 
经 典 的 DL, OWL- DL 本 体 已 经 可 以 通过 Web 公开 使 
用 ， 参 见 参考 文献 [9.13] 中 的 入 门 介绍 。 


9.1.2 概率 理论 


无 论 什 么 时 候 要 表示 实际 知识 ， 基 于 人 逻辑 的 KR 
形式 化 方法 都 是 值得 考虑 的 ， 由 此 可 以 进行 演绎 推 
理 。 但 机 器 人 要 用 到 的 关于 环境 的 部 分 知识 ， 并 不 真 
正 具备 这 一 特点 。 选 择 一 种 KR 形式 化 方法 〈 就 如 同 
选择 一 种 程序 设计 语言 ) ， 从 某 种 程度 上 是 一 种 汐 
试 、 经 验 、 熟 悉 度 或 集成 考虑 。KR 术语 中 ， 某 些 领 
域 形式 化 方法 的 认 知 适用 性 已 经 不 再 是 可 以 精确 判定 
的 问题 。 

然而 ,逻辑 (至少 其 经 典 变种 ) 不 能 满足 某 些 
应 用 类 型 的 知识 表示 需求 。 处 理 不 确定 性 问题 便 是 
其 一 ， 甚 至 可 以 说 是 全 部 ， 因 为 不 确定 性 本 质 上 就 
是 个 超载 的 概念 。 知 识 不 足 是 其 一 个 方面 ， 这 种 情 
况 逻辑 方法 可 以 处 理 ， 因 为 一 些 事实 的 真 假 值 可 以 
保持 在 未 确定 状态 。 但 若 知识 库 中 如 有 太 多 的 未 确 
定 知识 ， 逮 辑 方法 便 无 法 进行 令 人 感 兴 趣 的 演绎 推 
理 ， 因 为 这 时 候 在 逻辑 上 一 切削 有 可 能 。 不 过 ， 直 


兴趣 事件 的 概率 。 实 际 上 ， 有 一 种 重要 的 概率 推 
理 叫 诊断 推理 ， 即 ， 已 知 因果 规则 (指定 从 因 到 
果 的 条 件 概 率 ) ， 从 观察 到 的 结果 倒 推 回 隐 含 在 背 
后 的 原因 。 于 是 ， 对 于 潜在 的 原因 C 和 观察 到 的 结 
RE, PERKEN: 已 知 先 验 概率 PCC) 和 P(E)， 
前 定 后 验 概 率 P(C | 五 ) 。 解 当然 是 由 贝 叶 斯 规则 给 
1 如 下 : 


ZH yN 


P(E|C)P(C) 

P(E) 

然而 ， 和 逻辑 推理 一 样 ， 这 个 理论 上 很 有 吸引 力 
的 原理 已 经 被 证 明 : 如 果 只 是 朴素 地 应 用 则 是 不 实用 
的 。 考 虑 到 可 能 不 只 有 1 个 结果 被 观察 到 ， 而 是 nn 
个 ， 而 且 并 不 都 是 条 件 独立 的 。 用 贝 叶 斯 规则 的 一 般 
形式 ,计算 正确 的 后 验 概率 是 很 简单 的 ， 但 谁 能 指定 
所 涉及 的 所 有 概率 呢 ?” 最 坏 情 况 是 0(2")， 其 中 在 
实际 中 轻而易举 就 会 达到 几 百 。 
直到 20 世纪 80 年 代 末 期 ， 这 个 问题 才 或 多 或 少 
地 解决 了 。 一 种 方式 是 将 E, 故意 看 成 是 独立 的 ， 然 
后 简单 地 用 个 独立 条 件 概 率 PCE, | C). 近似 完全 的 
联合 概率 分 布 。 参 考 文献 [9.4] 第 14.7 节 对 此 及 其 
他 同类 方法 进行 了 综述 。 
贝 叶 斯 网 络 (BN) 从 其 问世 ”一 直 沿用 至 今 


P(C|E)- 


觉 上 不 同 的 可 能 结果 在 “可 能 性 ”上 会 有 显著 
区 别 。 

KR 领域 中 采用 贝 叶 斯 概率 作为 表示 和 推理 此 类 
不 确定 性 问题 的 手段 ， 它 利用 的 是 事实 间 的 相关 性 
而 不 是 严格 蕴含 。 需 要 注意 的 是 ， 这 种 方法 融合 了 
缺少 精确 的 、 完 备 的 知识 的 各 种 来 源 。 有 些 知识 是 
未 知 的 ， 要么 从 原理 上 就 是 不 可 知 的 ， 要么 就 是 建 
立 精 确 理论 或 确定 进行 可 靠 演 绎 推理 相关 的 全 部 信 
息 的 代价 太 高 。 无 论 哪 种 情况 ， 用 概率 (而 不 是 用 
二 值 真 值 ) 都 可 以 求 得 近似 结果 。 需 要 注意 的 是 ， 
这 里 真 值 的 概念 与 经 典 逻 辑 中 的 是 相同 的 ， 客 观 地 ， 
一 个 事实 被 假定 要 么 为 真 ， 要么 为 假 ， 概 率 就 是 对 
相信 事实 为 真 的 主观 程度 进行 建 模 。 需 要 注意 的 
是 ， 这 与 模糊 逻辑 不 同 ， 后 面 会 简要 讲解 (参见 
9.2.2 节 )。 

59.1.1 节 类 似 ， 这 里 假定 对 概率 论 的 基本 
概念 都 熟悉 。 人 参考 文 献 [9.4] 中 的 第 13 章 有 很 
好 的 基础 性 介绍 。 想 再 深入 了 解 ， 还 有 大 量 的 各 
种 导论 教材 。 参 考 文献 [9.14] 是 其 中 较 新 出 版 
的 一 部 。 

贝 叶 斯 概率 理论 中 的 推理 其 要 义 是 : 已 知 其 
他 先 验 概率 及 所 依赖 的 相关 概率 ， 来 推断 一 些 感 


其 思想 是 在 有 向 循环 图 中 表示 出 随机 变量 ， 其 中 ， 当 
且 仅 当 一 个 节点 直接 条 件 依 赖 于 对 应 的 父 节 点 变量 
十 ， 该 节点 就 是 父 节点 集 的 直接 前 驱 。 于 是 ， 巨 大 的 
完全 概率 分 布 就 被 无 损 地 分 解 成 通常 很 小 的 局 部 联合 
概率 ， 其 诀窍 是 使 用 许多 已 知 的 变量 间 的 条 件 独立 来 
大 大 降低 表示 和 推理 的 难度 。 

图 9.1 给 出 了 一 个 简单 的 贝 叶 斯 网 络 ， 表 示 D 由 
B 和 C 引 起 ， 由 条 件 概 率 表 给 出 的 概率 指定 局 部 的 联 
合 概 率 分 布 。 此 外 ， 图 中 的 结构 表明 ,知道 了 BB 和 CC， 
D 就 独立 于 A (知道 了 父 节点 时 ,该 节点 便 独立 于 其 
祖先 ) ， 知 道 了 4A,，B 便 独立 于 C， 即 ,P(C |4，B) = 
P(C|A) 和 P(B|4, C) =P(B|4)。 网 络 可 以 双向 
利用 : 自 底 向 上 ， 可 以 使 用 已 知 的 条 件 概率 去 解释 观 
察 到 的 现象 (诊断 ) Ai, WRR D, T LAHEK 
出 更 有 可 能 的 原因 (B 3X C); 自 顶 向 下 ， 可 以 传播 证 
据 来 计算 现象 出 现 的 概率 ， 如 , 已 知 4 (原因 ) 计算 
D 的 概率 。 

对 于 随 着 时 间 演 化 的 系统 ， 使 用 贝 叶 斯 网 络 的 
不 变 结构 以 便 使 用 相同 的 推理 过 程 更 新 变量 值 这 一 
点 很 重要 。 这 样 的 网 络 称 为 动态 贝 叶 斯 网 络 
(DBN)。 图 9.2 给 出 了 一 个 这 样 的 网 络 ， 从 时 刻 了 7 
到 时 刻 了 + 


In 


= 


o 
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P(A) POA) O 


|PCBIA) | PCBIA) | [PCCIA) | PC CIA) 
LPOT VA) |PCOBTEA) [PCA PCCI“A) 


Je 


图 9.1 附带 条 件 概率 表 的 简单 贝 叶 斯 网 络 结构 


(D 的 条 件 概率 表 依赖 于 了 和 C， 此 处 省 略 。) 
X) ——> Xl X2 XI X2 
Jo Yı 2 — n ya 
Zo Zi Z2 Zi 22 


图 9.2 两 个 相继 时 间 步 的 动态 贝 叶 斯 
网 络 实例 〈 其 结构 不 随时 间 改 变 ) 


在 9.3.3 节 中 ， 还 会 看 到 专门 用 于 不 确定 性 规划 
的 概率 技术 ， 如 马尔 可 夫 决 策 过 程 。 


9.2 机 器 人 的 知识 表示 问题 


本 章 余下 内 容 中 的 


理 方法 与 一 般 应 用 均 使 用 


(从 某 种 程度 上 讲 ) 逻辑 


的 基本 形式 化 方法 的 变种 或 


贝 叶 
变种 
应 用 中 有 所 贡献 。 


斯 概率 理论 。 两 种 形式 化 方法 〈 特 别 是 当 包含 
时 ) 都 如 此 通用 和 有 力 ， 以 至 于 可 以 在 任何 KR 


然而 ， 机 器 人 控制 系统 的 推理 与 其 他 基于 知识 的 


系统 中 的 推理 在 很 多 方 


看 都 有 所 不 同 。 基 于 知识 的 机 


At A FE MRA RABE, 


在 资源 相当 有 限 的 动态 环境 中 ， 


工作 在 闭环 控制 中 ， 通 常 是 
它 必 须 解 译 自 己 的 传 


感 天 输入， 至 少 要 自主 执行 一 部 分 判断 为 适当 的 动 
作 。 因 此 ， 基 于 知识 的 机 器 人 控制 有 特殊 需要 ， 可 以 


说 ， 这 些 需要 在 离线 的 专家 系统 中 是 没有 的 ， 专 家 系 
统 通 过 提示 专业 领域 中 有 经 验 的 人 来 输入 信息 ， 然 后 
将 输出 结果 写 和 人 到 文档 中 ， 给 更 有 经 验 的 人 去 分 析 ， 


如 果 他 们 感觉 正确 ， 还 可 


能 去 执行 。 自 然 地 ， 这 种 区 


别 形成 了 机 器 人 控制 对 KR 的 特殊 需要 ， 这 种 特殊 需 


要 可 能 许多 其 他 KR 用 户 


都 不 感 兴趣 ， 处 于 主流 领域 


之 外 。 本 节 简 要 地 探讨 三 个 问题 。 


正式 开始 之 前 ， 先 说 几 句 知识 表示 在 设计 智能 机 
器 人 或 智慧 机 器 人 时 的 作用 问题 。 


LET TRES 


明 ， 一 些 无 需 表示 的 智能 形式 "已 在 机 器 人 中 得 以 


实现 。 本 书 第 38 章 会 介绍 一 些 这 方面 的 背景 知 


识 。 


显然 ， 如 果 根 据 符号 进行 的 推理 不 能 以 真实 传 感 数据 


HABEN 
性 能 改善 、 软 件 设 计 和 用 户 接口 开发 大 有 神 益 ， 


如 ， 野 外 机 器 人 、 服 务 机 器 人 和 介入 机 器 人 等 应 用 
(JL Part F) 。 混 合 机 器 人 控制 系统 CULES 8 章 ) 是 当 


和 执行 器 控制 为 基础 ， 那 最 复杂 的 表示 和 推理 系统 对 
用 处 。 再 者 ， 表 示 与 推理 还 能 对 机 器 人 


fn 


前 常用 的 一 种 方式 ， 它 将 KR 技术 实例 与 机 絮 人 人 
反应 控制 组 件 融 合 在 一 起 


高 级 机 器 人 控制 逻辑 


9.2.1 


机 器 人 领域 本 质 上 是 动态 的 ， 包 括 至 少 一 个 物理 
用 基于 逮 辑 的 形式 化 方法 进行 表 
参考 文献 


Agent, BIELA o 
示 ， 会 产生 一 些 概念 上 和 技术 上 的 问题 ， 
9.4] 的 第 10. 3 节 对 此 进行 了 介绍 。 


Fr 


很 简单 ， 这 些 来 自 于 动作 逻辑 模型 的 精确 表示 和 


高 效 推理 的 需要 。 从 逻辑 上 讲 ， 一 个 独立 动作 改变 有 


限 数量 事实 的 真 值 ， 而 保持 其 他 的 不 变 。 


例如 ， 在 某 
象 级 别 上 将 从 一 处 走 到 另 一 处 的 动作 建 模 成 原子 动 


作 ， 它 在 执行 前 后 会 改变 机 器 人 的 位 置 。 依 靠 模型 
化 ， 它 可 以 改变 电池 状态 和 里 程 数 ， 但 不 改变 建筑 物 
的 布局 和 总 统 的 名 字 。 用 逻辑 语言 精确 地 形式 化 动作 
以 使 事实 〈 应 用 动作 序列 后 可 能 改变 也 可 能 不 变 ) 


可 被 有 效 


理 的 问题 ， 已 经 形成 了 一 个 术语 ， 称 为 


“框架 问题 "。 文 献 中 已 对 此 多 有 关注 ， 也 有 大 量 实 


际 的 解决 方案 。 
另 一 个 问题 涉及 由 独立 变化 的 事实 做 ; 
基于 知识 的 更 新 。 例 如 ， 


EK 


1 的 必要 的 
考虑 一 个 机 器 人 坐 在 某 扇 门 


DD 之 前 (由 
着 的 ,但 机 融 人 感知 到 的 是 一 扇 关 着 的 门 。 逻 辑 


3 定位 系统 告知 其 位 置 ) 相信 门 D 是 开 


E; 


这 是 一 个 矛盾 。 目 前 从 理论 上 有 几 种 方法 可 以 使 知识 
与 感知 一 致 。 一 种 方法 是 假定 D 是 从 学 习 到 它 是 开 


着 的 之 后 关上 的 ， 这 可 能 是 最 直观 的 解释 。 逮 辑 


E; 


恰 如 预 期 的 一 样 ， 例 如 ， 或 者 感知 失效 ， 或 者 机 器 人 


是 被 时 空 挪移 到 本 就 关 着 的 门 前 。 在 这 些 解 释 中 ， 


有 


些 在 表面 上 看 起 来 更 合理 ， 有 些 在 逻辑 上 需要 取消 更 


少 的 基于 知识 的 公式 从 而 成 为 首选 。 理 想 状态 下 ， 


在 


用 新 信息 替换 旧 信 息 时 ， 必 须 确认 已 经 取消 的 公式 的 


推论 不 再 


可 信 。 


理论 上 ， 这 些 问 题 要 多 难 有 多 难 。 实 际 上 ， 它 们 
可 以 被 充分 限定 在 一 个 精确 的 逻辑 框架 内 求解 。 根 据 
情境 演算 的 经 典范 例 *“"” i ， 典 型 的 求解 方案 会 在 公式 
中 采用 一 些 情境 或 保持 时 间 的 概念 ， 这 使 得 变化 可 以 


被 跟踪 。 典 型 的 求解 方案 也 会 放弃 推理 的 完备 性 ， 


采 


Tfi] 


用 类 似 PROLOG 的 推理 引 敬 。 这 样 的 解决 方案 在 
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机 器 人 控制 中 已 见报 道 的 应 用 有 三 个 案例 ， 即 
GOLOG!" si P9130 FLUX?! , 
9.2.2 模糊 逻辑 方法 

由 于 历史 原因 ， 处 理 经 典 AT 问题 的 大 量 方法 和 
技术 已 经 超出 了 AI 的 核心 范围 ， 这 些 方法 在 不 同 的 
领域 中 有 时 被 称 作 软 计算 ， 有 时 被 称 作 计算 智能 ， 其 
中 就 包括 模糊 逻辑 。 模 糊 逻 辑 显 然 也 是 一 种 符号 推理 
方法 ， 而 且 ， 它 与 模糊 控制 有 着 共同 的 理论 基础 。 
为 模糊 控制 已 经 以 这 样 或 那样 的 方式 大 量 应 用 在 机 器 
人 控制 器 中 ， 所 以 模糊 逻辑 也 理所当然 地 成 为 机 器 人 
知识 表示 的 一 种 形式 化 方法 。 

首先 ,模糊 逻辑 的 本 体 论 基础 与 FOPL 和 概率 理 
论 的 有 所 不 同 ， 后 者 假定 谓词 客观 上 或 为 真 或 为 假 ， 
可 能 不 知道 其 真 值 ， 但 它 确实 存在 。 模 糊 逻 辑 则 假定 
真 值 客观 上 以 某 种 程度 呈现 。 许 多 自然 语言 范畴 具有 
模糊 特点 ， 如 ， 说 某 人 “大 ”， 可 以 解释 为 在 某 些 极 
端 情况 下 客观 上 是 真 或 假 ， 但 如 何 客 观 地 说 一 个 高 
185cm Œ 80kg 的 男人 算 不 算 大 呢 ? 

模糊 逻辑 被 看 成 是 命题 逻辑 (在 此 领域 中 常 被 
称 作 清 晰 逻辑 ) 的 推广 。 因 此 ， 模 糊 逻 辑 使 用 规范 
的 联结 词 A、V 、- 等 ,但 要 将 其 真 值 函 数 的 定义 从 
集合 10, 1] 推广 到 [0, 1] 区 间 。 有 几 种 看 起 来 
挺 合理 的 推广 方法 ， 和 常用 的 一 种 是 定义 : 

value(^ P) =1 - value( P) 

value( P V Q) = max | value( P) ,value( Q) | 

其 他 联结 词 的 定义 可 以 如 法 炮制 ， 已 有 大 量 不 同 
的 定义 付 诸 应 用 。 

模糊 演绎 推理 与 命题 演绎 推理 目的 典型 地 不 同 ， 
因此 推理 机 制 也 不 同 。 一 些 模糊 逻辑 理论 中 的 可 满足 
性 通常 已 经 不 再 是 人 们 感 兴趣 的 问题 ， 因 为 它 也 只 是 
在 某 种 程度 上 的 可 满足 ， 而 大 多 数 模糊 系统 通常 都 能 
至 少 有 点 儿 可 满足 性 。 模 糊 罗 辑 知识 库 通常 用 在 模糊 
推理 规则 集 上 的 前 向 链 推理 方式 中 ， 从 其 他 已 知 的 模 
糊 值 推断 出 模糊 变量 的 模糊 值 ， 这 就 是 模糊 知识 库 成 
功 应 用 于 机 器 人 控制 器 的 方式 ， 如 用 在 Saphira 控制 
结构 中 ”1 。 举 例 来 说 ， 用 如 下 规则 确定 移动 机 器 人 
的 转向 角 是 有 意义 的 : 


if( freeRange right is. narrow) ^ (freeRange front is. 


medium) ^ ( freeRange left is, wide) 
then set angle medium. lefi 


其 中 ， 和 斜体 部 分 (right, is narrow 等 ) 是 模糊 变量 。 


O VERE: 


在 某 特定 时 刻 ， 前 提 变 量 的 模糊 真 值 可 通过 定义 变量 
映射 然后 读 取 距 离 传感器 数据 来 确定 ， 如 将 is_medi- 
dium, lefi 可 以 映射 为 以 向 左 30° 为 均值 的 正 态 分 布 
上 ， 而 实际 设置 的 角度 最 终 将 通过 去 模糊 化 来 计算 ， 
即 ， 将 最 适用 的 规则 或 规则 集 的 模糊 变量 组 合 起 来 ， 
一 个 看 起 来 比较 合理 的 标量 值 可 能 是 结果 模糊 值 的 
重心 。 

尽管 在 软 计算 与 核心 AI 之 间 存 在 着 世界 观 上 的 
争论 ， 但 模糊 推理 组 件 与 其 他 AT 组 件 还 是 能 很 好 地 
共处 于 一 个 机 器 人 控制 器 中 ,各 司 其 职 ，Saphira 体 
系 结构 便 是 一 例 。 


9.2.3 时 间 约 束 推 理 


与 很 多 一 般 的 AI 系统 不 同 ， 为 了 应 对 环境 的 动 
态 性 ， 机 器 人 必须 基于 传 感 数据 实 时 进行 决策 ， 因 此 
它们 的 决策 应 该 在 有 限 的 时 间 内 生成 。 如 果 这 些 决 策 
需要 考虑 未 来 计划 ， 即 如 果 需 要 规划 ， 问 题 就 来 
了 一 一 实时 决策 实际 上 与 规划 的 无 界 性 并 不 兼容 
(规划 的 通用 形式 是 个 很 难处 理 的 问题 ) ， 再 加 上 基 
T FOPL 推理 机 制 又 只 是 半 可 判定 的 。 

为 了 考虑 实时 约束 ， 人 们 提出 了 反应 规划 等 方 
法 ， 均 放弃 了 太 多 的 超前 规划 (一 次 只 规划 一 
步 ) 。 然 后 ， 时 间 约 束 的 解决 方案 通常 来 自 机 器 人 
系统 的 体系 结构 设计 (参见 第 8 章 ) ， 它 集成 决策 
层 和 反应 层 (可 以 在 有 限时 间 内 做 出 反应 )。 决 策 
层 常 包含 规划 器 和 监控 系统 ， 用 预定 义 的 过 程 或 脚 
本 确保 任务 执行 监视 。 该 监视 组 件 必 须 既 是 目标 驱 
动 的 又 是 事件 驱动 的 ， 目 标 驱动 用 以 完成 任务 ， 导 
件 驱 动用 以 对 环境 变化 做 出 反应 。 过 程 推理 系统 
(PRSP??U) 便 是 这 样 的 一 个 例子 ， 它 包括 一 个 过 
程 集 、 一 个 由 感知 和 系统 状态 演化 来 更 新 的 数据 库 
以 及 一 个 解释 器 ， 解 释 器 用 以 根据 数据 库 的 内 容 启 
动 适用 的 过 程 。 

随时 算法 ”31 〇 都 被 开发 成 对 时 间 约 束 的 可 能 
响应 。 其 基本 思想 是 ， 算 法 操作 时 间 越 长 ， 其 解 越 接 
近 最 优 。 然 而 ， 如 果 缩 短 时 间 ， 算 法 也 能 产生 一 个 
解 ， 可 能 远 未 达到 最 优 ， 但 可 使 系统 继续 执行 而 不 用 
被 阻塞 等 待 决策 结果 。 随 时 算法 评价 解 的 质量 ， 并 用 
性 能 配置 文件 预测 该 质量 如 何 随 着 时 间 的 推移 而 被 
改善 。 


T8 


H 


一 类 随时 可 以 中 断 执行 并 输出 近似 最 优 解 的 算法 。 
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9.3 动作 规划 


本 章 余 下 的 内 容 将 从 推理 方法 转向 两 类 推理 应 
用 ， 即 动作 规划 与 学 习 。 

从 传统 AI 的 意义 上 讲 ， 规 划 意 味 着 Agent 对 要 
达到 给 定 目 标 集 所 要 采取 的 一 系列 动作 进行 慎 思 ， 调 
度 意味 着 给 动作 集 分 配 时 间 和 其 他 潜在 的 资源 ， 以 使 
满足 给 定 的 时 限 并 遵守 时 间 约 束 。 这 两 个 活动 在 概念 
上 是 不 同 的 ， 并 在 历史 上 常 被 以 级 联 方式 处 理 一 一 先 
规划 ， 再 调度 。 不 过 ， 最 近 随 着 更 多 高 效 时 序 推 理 方 
法 和 规划 算法 的 出 现 ， 有 将 二 者 以 集成 方式 处 理 的 趋 
势 。 这 是 因为 ， 先 根据 一 些 指标 生成 最 优 规划 ， 再 为 


表示 出 来 ， 包 括 动作 执行 效果 、 对 环境 随时 间 变 化 保 
持 跟踪 并 合理 处 理 任何 不 确定 性 和 缺少 信息 的 情况 。 
从 这 个 意义 上 讲 ， 规 划 涵盖 了 本 章 中 前 面 介 绍 的 各 种 
推理 方法 。 

慎 思 的 极端 形式 是 事前 进行 环境 仿真 ， 涉 及 
Agent 的 各 种 可 能 动作 ， 然 后 从 中 选择 出 看 起 来 最 好 
的 动作 予以 执行 。 实 际 上 ， 至 少 有 两 个 理由 可 以 说 明 
这 是 不 可 能 的 。 首 先 ， 通 常 并 非 真 实 仿真 所 需 的 全 部 
信息 都 是 可 用 的 ， 规 划 是 为 了 真实 环境 ， 其 中 许多 参 
数 都 是 未 知 或 不 可 知 的 ， 且 不 在 Agent 控制 之 下 ; 其 
次 ， 即 使 完全 仿真 的 全 部 信息 都 是 已 知 的 ， 但 是 很 有 
可 能 因为 计算 复杂 度 高 而 使 得 真实 环境 总 是 超前 于 仿 
真 。 因 此 ， 规 划 域 表示 要 故意 抽象 掉 很 多 或 大 部 分 细 


此 规划 设计 最 优 调度 ， 可 能 无 法 产生 一 个 时 间 和 资源 
上 都 是 最 优 的 调度 。 但 将 二 者 分 开 考 虑 也 是 有 意义 
的 ， 因 为 它们 并 不 总 是 需要 组 合 起 来 。 总 之 ， 本 书 将 
跳 过 调度 的 集成 ， 参 考 文献 [9.27] 第 TV 部 分 有 一 
个 全 面 的 综述 。 

机 器 人 控制 已 在 规划 的 最 先 应 用 之 列 ， 如 
STRIPS AB?) 就 已 被 用 来 为 SHAKEY ”机 器 人 
生成 规划 ( 即 待 执行 的 抽象 级 动作 序列 ) 。 在 机 器 人 
控制 体系 结构 中 ,包含 抽象 动作 的 规划 要 被 分 解 成 物 
理 操作 ， 这 些 物 理 操作 要 有 足够 的 柔性 ， 除 了 应 对 偶 
然 性 、 意 外 性 和 失效 外 还 要 能 实现 规划 ， 这 正如 人 对 
规划 的 智能 用 法 的 直观 期 望 一 样 。 业 已 证 明 , 设计 这 
样 一 种 机 器 人 控制 体系 结构 是 非常 重要 的 。 

本 部 分 内 容 从 如 何 为 规划 器 的 规划 域 建 模 人 手 ， 
然后 在 9. 3. 2 节 介 绍 在 很 多 简化 假设 下 高 效 工作 的 规 
划算 法 ，9.3. 3 节 松 弛 这 些 假设 ， 处 理 不 确定 性 Cl 
可 观测 性 缺失 ) 问题 ，9. 3.4 节 收 篇 简要 探讨 机 右 人 
规划 。 
想 全 面 了 解 动 作 规划 有 关内 容 ， 推 荐 阅读 参考 文 
献 [9.27]。 在 AI 教科 书 (如 参考 文献 [9.4] 中 的 
第 11、12、16 和 17 等 章节 ) 中 会 有 关于 动作 规划 的 


节 ， 以 便 使 得 有 效 规划 成 为 可 能 。 正 如 在 KR 的 所 有 
形式 中 一 样 ， 域 模型 的 精确 性 和 完备 性 需要 对 推理 速 
度 进行 折 中 。 

究竟 有 多 少 细节 和 哪些 细节 要 表示 ， 这 是 建立 规 
划 系 统 时 要 做 出 的 工程 决策 。 因 此 ， 对 域 可 能 要 做 些 
简化 假设 ， 主 要 包括 : ERE ( 域 只 有 有 限 个 对 象 、 
动作 和 状态 ) ; 信息 完备 性 (规划 器 在 规划 时 具备 所 
有 相关 信息 ); 确定 性 (每 个 动作 的 执行 结果 都 是 确 
定 的 ) ; 瞬时 性 (动作 没有 持续 时 间 ); 停 清 性 (BL 
划 期 间 环境 不 发 生 改 变 ) 。 
通常 ， 限 制 性 假设 可 以 提高 算法 效率 ,但 在 执行 
时 当 简 化 解 遭 遇 真 实 环境 时 便 可 能 出 现 问 题 。 值 得 注 
意 的 是 ， 使 用 简化 域 模型 绝 不 意味 着 假定 环境 客观 上 
就 是 如 此 。 举 例 来 说 ， 仅 对 标准 情况 (假定 最 简 情 
况 ) 进行 规划 然后 处 理 执行 时 发 生 的 各 种 异常 是 有 
意义 的 。 在 机 器 人 规划 中 ， 这 种 思想 可 以 追溯 到 
SHAKEYL 2 。 
目前 常用 的 域 表 示 法 主要 有 两 类 。 稍 后 会 介绍 
PDDL 型 的 描述 ，9. 3. 3 节 将 对 不 确定 域 表示 法 进行 
粗略 介绍 。 此 外 ， 与 这 两 类 域 表 示 法 正 交 的 演绎 规 
划 有 多 种 形式 ， 它 们 使 用 纯 逻 辑 表示 法 的 一 些 变种 ， 


简介 。 参 考 文献 【9.31] 对 规划 方法 的 最 新 进展 有 
简要 的 综述 。International Conference on Automated 
Planning and Scheduling (ICAPS) 是 目前 本 领域 最 主 
要 的 国际 会 议 ， 每 年 召开 一 次 。PLANET 在 线 研究 数 
据 库 ”中 包含 一 系列 持续 更 新 的 体现 目前 发 展 水 平 
的 规划 器 、 调 度 器 和 相关 工具 的 链接 。 参 考 文献 
[9.33] 中 包含 一 个 当前 现状 的 应 用 前 景 展望 以 及 一 
个 2003 年 末 时 对 这 一 领域 的 前 景 展望 。 


9.3.1 规划 域 描述 
Agent 对 行动 过 程 的 慎 思 需要 将 它 的 可 能 动作 都 


有 关 介 绍 内 容 可 参见 参考 文献 [9.27] 中 的 第 
12 章 。 

秉承 上 述 所 有 假设 的 简单 特点 ， 域 描述 主要 包含 
两 部 分 。 第 一 部 分 是 一 个 受 限 一 阶 谓词 语言 的 规格 
说 明 ， 由 与 环境 建 模 有 关 的 表示 关系 的 谓词 符号 和 
表示 对 象 的 常量 构成 ; 第 二 部 分 是 一 个 动作 描述 集 
内， 对 于 每 个 动作 ae ， 都 由 前 件 pre(a) 和 后 件 
post(a) 构成 ， 前 件 即 .中 的 事实 集 ， 当 其 值 为 真 时 
a 方 可 执行 ; 后 件 也 是 .中 的 事实 集 〈 正 的 或 负 的 ) ， 
执行 a 后 其 值 变 为 真 。 
举 个 简单 的 例子 ( 源 自 参考 文献 [9.27] 第 35 
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页 ) ， 表 9. 1 给 出 了 在 相 邻 接 的 位 置 ! 到 位 置 m 移动 
HAFA r 的 动作 图 式 。 在 规划 过 程 中 ,通过 用 常量 对 
象 代 换 变 量 ， 动 作 图 式 被 实例 化 成 规划 中 发 生 的 
动作 。 


39.1 相 邻 接 的 位 置 ! 到 位 置 m 移动 
机 器 人 7 动作 图 式 

(:action move 

: parameters (? r-robot ? 1 ? m-loca- 
tion) 

:precondition (and (adjacent ? 1 ? m) 
(at? r? 1) 

(not(occupied ? m))) 

:effect(and(at ? r ? m) (occupied ? m) 

(not(occupied ? 1))(not(at ? r? 1)))) 


给 定 一 个 域 ， 那 么 一 个 具体 的 规划 问题 就 用 < 语 
言 由 下 列 组 件 确 定 : 

1) 初始 状态 1， 是 语言 中 在 开始 执行 之 前 即 为 
真 的 所 有 事实 的 集合 。 

2) 目标 条 件 6， 是 .语言 中 由 执行 一 个 规划 所 
诱导 的 事实 集 。 
在 该 框架 下 的 规划 是 典型 的 实际 动作 (自由 变 
量 ) 的 偏 序 集 ， 这 些 实际 动作 是 要 按照 顺序 执行 的 。 
规划 域 描述 语言 (PDDL)“” 是 目前 用 于 描述 规 
划 域 的 事实 上 的 标准 。 实 际 上 ，PDDL 代表 着 一 整 类 
语言 ， 允 许 或 禁止 诸如 参数 类 型 、 恒 等 处 理 、 条 件 动 
作 效 果 以 及 一 些 FOPL 语句 的 限制 形式 等 特征 。 举 一 
个 条 件 结果 的 例子 ， 考 虑 机 器 人 在 move 动作 中 可 不 
可 以 加 载 一 些 容 器 “? ce”， 那 么 ， 作 为 一 个 附加 结 
果 指定 “? ce” 将 随机 器 人 移动 : 


(when( loaded ? r ? c) 
$ condition 
(and(at ? c? m)(not(at ? c? 1)))) 


$ effect. 


除了 上 述 形式 ， 原 始 的 PDDL 还 有 些 扩展 版 本 ， 
其 中 PDDL2. 1 1 是 最 值得 一 提 的 ， 它 允许 信息 被 表 
示 成 时 序 规划 ， 如 ， 人 允许 动作 有 持续 时 间 。 

规划 是 计算 困难 的 。 对 于 PDDL 型 问题 的 命题 变 
种 〈 即 用 有 限 的 语言 2) ， 规 划 的 存在 性 当然 是 可 判 
定 的 ， 但 求解 规划 问题 是 P 空间 完全 的 。 


偏 序 规划 生成 
许多 规划 系统 及 其 基础 规划 算法 都 接受 前 已 述 及 


9. 3.2 


的 限制 性 假设 ， 即 信息 的 完备 性 、 确 定性 、 瞬 时 性 和 
停滞 性 ， 因 此 ， 刚 才 给 出 的 规划 问题 的 定义 都 适用 。 
于 是 ， 要 找 的 那 种 规划 就 是 一 个 动作 集 ， 通 过 执行 这 
些 动作 可 将 初始 情境 变换 到 目标 条 件 为 真 的 情境 
C 目标 情境 不 必 唯 一 ) 。 对 此 规划 模型 不 必 做 有 限 性 
假设 ， 但 为 简化 起 见 我 们 还 是 要 这 样 做 ， 这 意味 着 所 
有 动作 实例 可 以 被 假设 为 是 真实 的 。 

通常 ， 规 划 中 的 动作 不 能 以 任意 顺序 随意 执行 ， 
但 也 必须 按 一 定 的 顺序 执行 ， 以 确保 每 个 动作 的 所 有 
前 件 在 该 动作 执行 的 一 刻 为 真 。 这 个 顺序 不 必 是 全 序 
的 或 线性 的 ， 但 可 以 是 偏 序 的 或 非 线 性 的 。 相 应 类 型 
的 规划 被 称 为 非 线 性 或 偏 序 规划 ， 总 之 ， 定 义 为 一 个 
动作 实例 集 4 和 偏 序 关 系 < 对 <4，< > 。 无 序 动作 
可 以 以 任意 顺序 执行 ， 考虑 到 动作 建 模 ,它们 也 可 以 
并 发 执行 ， 这 意味 着 在 同一 个 原子 时 间 步 内 执行 
(假设 具备 瞬时 性 ) 。 

对 于 一 个 规划 ， 作 为 给 定 规划 问题 的 一 个 解 ， 每 
个 动作 ae A, 在 每 个 与 < 兼容 的 可 能 执行 顺序 中 都 
需要 其 前 件 为 真 ， 按 任何 一 种 可 能 顺序 执行 之 后 ， 目 
标 条 件 必 须 为 真 。 

自 20 世纪 七 八 十 年 代 的 一 阶 偏 序 规划 方法 开始 ， 
到 SNLP (系统 非 线性 规划 ) 算法 “ 1 及 其 衍生 算法 
达到 识 峰 状态 ,一 系列 高 效 的 偏 序 规划 算法 应 运 而 
生 ， 这 些 算 法 通过 各 种 技术 来 提高 效率 ， 如 系统 化 、 
反 向 链 、 最 小 承诺 、 密 集 推 理 等 。 参 考 文献 【9.4] 
中 的 第 11.3 节 对 此 作 了 介绍 ， 并 提供 了 一 些 参考 文 
献 。 按 这 条 线 下 来 的 方法 通常 被 称 为 传统 规划 。 

下 面 是 生成 一 个 解 规划 的 算法 思想 : 从 仅 包含 初 
始 事实 和 目标 条 件 的 空 规划 开始 ， 和 迭代 检查 在 当前 规 
划 中 出 现 的 所 有 条 件 在 所 有 < 允许 的 执行 顺序 中 是 否 
为 真 ， 如 果 发 现 某 条 件 c 还 不 满足 ， 可 以 通过 以 下 两 
种 方法 来 处 理 : 或 者 插入 一 个 新 的 动作 作为 结果 生成 
c， 或 者 调整 规划 中 已 有 的 一 个 动作 使 e 在 需要 的 时 
候 变 为 真 。 如 果 所 有 动作 彼此 独立 ， 这 样 工作 起 来 效 
率 会 很 高 ， 但 通常 它们 并 不 独立 一 一 一 个 c 一 旦 在 规 
划 中 实现 ， 它 就 会 由 于 某 个 动作 结果 中 包括 ” e 而 威 
胁 到 其 后 的 条 件 。 传 统 规划 系统 中 ， 人 们 在 算法 规则 
或 启发 式 方面 做 了 不 少 努力 ， 探 究 了 如 何 有 效 阻 止 或 
处 理 规 划 中 的 子 目标 相互 作用 。 

将 子规 划 预 定义 为 宏 是 很 多 应 用 系统 中 都 采用 的 
技术 ， 宏 在 规划 内 形成 一 种 分 层 结构 ， 由 此 得 名 分 层 
任务 网 络 (HTN)， 参考 文献 [9.27] 中 第 11 章 对 
此 有 介绍 。 形 式 上 ， 子 规划 可 以 表示 成 任务 ， 即 带 有 
前 件 和 后 件 的 动作 ， 规 划 时 可 以 拓展 到 其 底层 子规 
划 。 任 务 可 以 分 层 。 只 要 还 包含 未 扩展 的 任务 ， 规 划 


Rl 
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就 没有 完成 。 之 所 以 使 用 HTN 是 由 于 规划 域 建 模 者 
知道 ， 通 常 〈 实 际 上 ， 在 所 有 的 实际 应 用 中 ) 反复 
使 用 的 子规 划 不 必 由 规 划 器 每 次 从 头 开始 构造 。 而 


第 一 层 Fy 由 代表 问题 完全 初始 情境 的 全 部 事实 
节点 构成 ， 最 后 一 层 也 是 事实 层 。 当 且 仅 当 事 实 在 动 
作 前 件 之 中 时 ， 用 边 连 接 相 应 事实 节点 和 动作 节点 ; 


EH, HTN 的 分 层 特 性 可 以 使 更 大 规模 的 规划 以 易于 
人 管理 的 方式 展现 出 来 。HTN 已 被 用 了 很 长 时 间 ， 
效果 甚 佳 。SIPE (交互 规划 与 执行 监控 系统 )' "是 
其 中 适用 于 实际 应 用 的 首选 规划 器 ， 最 近 的 SHOP 
(简单 分 层 有 序 规划 器 )， ”是 其 中 的 佼佼 者 。 

从 GRAPHPLAN" 0 开始， 这 一 领域 便 致力 于 开 
发 偏 序 规划 算法 (被 参考 文献 [9.27] 称 为 新 传统 
规划 ) 的 相关 技术 ， 偏 序 规划 算法 背离 了 传统 算法 ， 
而 保持 生成 顶级 性 能 规划 器 。 下 面 将 详细 介绍 其 中 的 
两 个 方法 ， 即 规划 图 和 变换 成 可 满足 性 问题 。 

近来 对 规划 器 性 能 的 改善 大 部 分 都 归功 于 把 规划 
形式 化 为 一 类 特殊 的 搜索 问题 ， 于 是 强 有 力 的 启发 式 
方法 便 可 派 上 用 场 ， 详 见 参 考 文献 [9.27] M 
部 分 。 

1. 规划 图 

GRAPHPLAN 的 关键 思想 之 一 是 从 预 处 理 阶 段 开 
始 构建 规划 ， 即 ; 

1) 确定 在 n 个 时 间 步 内 可 解 的 必要 条 件 (其 中 
n 在 找到 解 之 前 一 直 递 增 ) 。 

2) 输出 一 个 结构 化 表示 ， 如 果 存 在 一 个 n 时 间 
步 偏 序 规划 ， 便 可 基于 此 结构 将 其 相对 高 效 地 抽取 


当 且 仅 当 事实 在 动作 结果 中 时 ， 将 动作 节点 与 事实 节 
点 相连 。 除 了 域 描述 的 动作 集 4，PG 还 包括 伪 动 作 
用 于 将 事实 层 的 每 个 事实 复制 到 下 一 个 事实 层 (在 
语法 上 , f 的 伪 动 作 与 1 具有 完全 一 样 的 前 件 和 结 
AL). PG 在 任 一 4; 层 中 包含 动作 节点 (对 应 可 用 的 
全 部 动作 ) ， 给 定 F WEK, F 包含 所 有 A 动作 后 
件 中 包含 的 全 部 事实 。 

对 于 一 个 给 定 的 有 限 的 规划 问题 ，PG 是 由 层 内 
节点 序列 唯一 确定 的 。 它 无 需 搜 索 就 可 扩展 ， 只 需 从 
最 后 一 个 事实 层 向 前 链接 ， 把 所 有 适用 的 动作 搬入 到 
下 一 个 动作 层 ， 将 这 些 动作 的 结果 插入 到 下 一 个 事实 
层 。 动 作 和 事实 集 随 着 层 数 单调 增长 ， 因 此 PG 的 生 
成 可 以 在 有 限 域内 终止 。 

规划 问题 可 解 的 必要 条 件 是 存在 一 个 事实 层 包含 
所 有 目标 事实 。 如 果 能 在 n 个 时 间 步 发 现 该 层 ， 
PG 暂停 扩展 并 尝试 提取 规划 ， 向 后 收集 解 规划 。 从 
F, 层 中 的 目标 事实 开始 ， 追 溯 F,_, 层 中 的 动作 4, 的 
BIE, MÆR F, 中 事实 所 需 的 每 个 动作 A, 中 选 出 一 
系列 动作 。 

规划 的 提取 不 一 定 能 成 功 ， 因 为 所 需 动作 可 能 在 
共同 的 动作 层 中 相互 排斥 一 一 与 传统 规划 中 的 子 目标 


出 来 。 

这 种 结构 便 是 规划 图 (PG)， 即 一 个 真实 事实 
点 和 真实 动作 节点 的 分 层 有 向 无 环 二 部 图 ， 其 中 事 3 
节点 和 动作 节点 的 层次 可 以 互 换 。 图 9.3 给 出 了 有 3 
个 接续 层 的 示意 图 。 
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图 9.3 一 个 规划 图 结构 〈 圆 圈 代 表 事 实 节点 ， 
矩形 框 代表 动作 节点 ， 小 方 框 代表 伪 算 子 ) 


相互 作用 类 似 。 因 此 ， 某 F, 中 的 目标 条 件 只 是 可 解 
的 必要 条 件 ， 而 非 充分 条 件 。 一 般 情 况 下 ， 从 PG 中 
提取 规划 要 用 到 搜索 ， 尽 管 比 传统 规划 算法 中 的 搜索 
空间 要 小 得 多 ， 但 通常 远 远 超过 最 初 构建 PG。 

PG 的 主要 缺点 是 它们 要 求 域 有 限 的 〈 即 命题 
的 ) ， 而 且 ， 其 语言 .必须 大 小 有 限 ， 因 为 所 有 的 
事实 和 动作 实例 都 要 为 扩展 PG 而 明确 地 构建 
出 来 。 

2. 作为 可 满足 性 问题 的 规划 

从 规划 研究 的 早期 开始 ， 人 们 就 已 经 尝试 把 规 
划 生 成 问题 表示 成 传统 逻辑 中 的 推理 问题 ”21 。 这 
样 做 因为 两 个 原因 也 许 很 有 用 : 首先 , 已 有 有 效 的 
逻辑 推理 器 对 规划 可 能 有 用 ， 节 省 了 研究 专门 规划 
算法 的 气力 ; 其 次 ， 域 中 的 逻辑 推理 将 被 无 颖 集成 
到 规划 中 ， 从 而 可 以 白白 得 到 一 种 强 有 力 的 域 表 
示 法 。 

FOPL 中 对 变化 与 不 变 的 有 效 表 示 已 经 被 归 为 杠 
架 问 题 8S ， 详 见 参考 文献 [9.4] 的 第 10.3 节 的 介绍 。 


O Mum: 框架 问题 主要 研究 情境 演算 中 不 变 的 事物 如 何 表示 。 
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同时 ， 有 若干 种 方法 以 各 种 逻辑 形式 来 表示 规划 | 
题 ， 并 有 一 些 演绎 规划 器 在 那个 时 代 达 到 了 项 级 性 
能 。 例 如 ， TALplanner.”®] 采用 了 时 序 逻 辑 表 示 法 ， 
Blackbox ^ “| 采用 命题 逻辑 编码 ， 其 规划 算法 结合 
PG 命题 逻辑 编码 为 使 用 有 效 的 模型 检查 器 (参见 
9.1 节 ) 进行 推理 提供 了 选择 。 这 对 PG 任何 时 候 都 
是 适用 的 。 参 考 文献 [9.27] 中 的 第 7 章 对 此 进行 
了 介绍 。 

有 限 规 划 问 题 的 命题 表示 法 可 以 从 给 定 域 和 问 
题 描述 比照 先 验 图 式 得 出 ， 如 同 为 Blackbox 开发 的 
方法 一 样 。 事 实 被 指定 附加 的 情境 参数 ， 带 有 在 情 
境 间 迁移 的 动作 。 初 始 事实 、 目 标 事 实 和 动作 结 
的 命题 逻辑 表示 很 简单 。 令 人 感 兴趣 的 部 分 (参见 
9.2.18) 由 解释 性 框架 公理 构成 ， 即 一 个 形式 化 
公理 集 ， 两 种 情境 间 事 实 真 值 的 任何 变化 都 需要 应 
解释 ， 在 该 动作 的 结果 中 具有 改变 的 事 
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9.3.3 不 确定 性 规划 


虽然 信息 完备 性 、 确 定性 和 停滞 性 在 某 个 抽象 级 
对 规划 域 通常 是 有 用 的 近似 ,但 在 其 他 情形 却 未 必 有 
用 ， 而 这 绝 不 意味 着 正好 相反 的 情形 就 是 对 的 ， 这 种 
情况 下 ， 规 划 几 乎 也 就 没什么 意义 了 。 很 多 域 表现 出 
未 知 的 、 随 机 的 和 动态 的 一 面 ， 但 依然 提供 一 定 程度 
的 信息 和 控制 ， 利 用 这 个 来 弥补 信息 和 控制 的 不 足 便 
是 不 确定 性 规划 的 思想 ， 根 据 域 模型 不 完整 性 的 内 容 
和 程度 ， 有 不 同 的 形式 ， 本 节 扼 要 介绍 其 中 的 一 种 ， 
详细 介绍 可 以 参见 参考 文献 [9.27] 的 第 V 部 分 和 
参考 文献 [9.4] 的 第 12、16 和 17 章 。 参考 文 献 
[9.44] 第 部 分 介绍 了 机 器 人 环境 中 的 概率 规划 技 
术 。 参 考 文献 [9.45] 建立 了 前 述 的 传统 规划 和 各 
种 不 确定 性 规划 的 统一 视图 。 

假定 某 些 动作 可 能 具有 不 确定 性 结果 ， 且 这 些 结 
果 出 现 的 相对 频率 信息 (近似 的 或 估计 的 ) 可 用 。 
在 这 种 情况 下 ， 概 率 框架 下 的 表示 法 便 应 运 而 生 ， 如 
马尔 可 夫 决 策 过 程 (MDP), MDP 用 有 限 状 态 集 5、 
有 限 动作 集 4 和 动作 模型 表示 域 。 动 作 模型 设 定 : 对 
于 每 个 ws4， 在 状态 * DU a 终止 于 状态 y 的 条 件 概 
率 分 布 为 P,(s' |s)。 例 如 ,假定 机 器 人 的 当前 位 置 
是 状态 描述 的 一 部 分 ， 从 当前 位 置 ! 移动 到 邻接 的 自 
由 位 置 m 的 高 层 动 作成 功 移 动 到 m 的 情况 占 95% , 
未 指定 (可 能 是 未 知 ) 的 条 件 使 机 器 人 留 在 位 置 1 的 
情况 占 剩 下 的 5% 。 

状态 伴随 着 效用 ， 动 作 的 耗费 可 以 建 模 成 结果 状 
态 的 负 效 用 。 在 这 种 框架 下 的 规划 意味 着 要 寻找 一 个 


动作 序列 ， 不 仅 考 虑 到 每 个 算 子 的 惟一 标准 结果 ， 而 
且 考 虑 到 所 有 可 能 的 结果 ， 包 括 那 些 不 太 可 能 但 会 产 
生 很 大 耗费 的 结果 (考虑 在 一 个 陡峭 的 楼 梯 附 近 轮 
式 平台 可 能 的 运动 误差 ) 。 

在 此 框架 下 的 规划 就 是 决策 论 中 的 策略 ， 即 从 状 
态 映射 到 动作 的 函数 。 基 本 规划 算法 有 值 迭 代 (VI) 
MRE (PI， 见 参考 文献 [9.4] 第 17 章 )。 对 
有 限 状 态 集 ， 二 者 都 收敛 到 最 优 策略 。 其 差别 是 VI 
是 通过 驯 近 给 定 状态 最 优 策略 的 真实 效用 来 实现 的 ， 
而 PL 只 寻找 最 优 策略 ， 节 省 了 确定 其 精确 效用 值 的 
气 办 。 

MDP 还 假设 状态 在 执行 时 是 可 观察 的 ， 即 Agent 
能 够 确切 知道 自己 处 于 什么 状态 ， 并 能 在 策略 中 确 
切 地 选取 相应 的 分 支 ， 这 在 一 些 机 器 人 应 用 中 可 能 
不 方便 。 进 一 步 跳 过 可 观测 性 假设 ， 便 引出 了 部 分 
可 观测 MDP (POMDP) POMDP 在 MDP 中 增加 一 
个 观测 模型 ， 由 Agent 进行 的 可 能 观测 的 有 限 集 0 
及 在 状态 s 观察 o 的 条 件 概率 P(o | s) 构成 。POM- 
DP 也 被 用 于 移动 机 器 人 定位 与 标 图 的 形式 模型 ( 见 
第 37 章 ) 。 
POMDP 的 最 优 策 略 是 仿照 MDP 来 定义 的 ， 但 人 
们 发 现 它们 计算 困难 。 一 种 常用 的 方法 是 考虑 信念 空 
间 而 不 是 状态 空间 ， 即 状态 空间 上 的 概率 分 布 空 间 ， 
对 应 Agent 在 执行 一 个 动作 或 观测 之 后 对 自己 可 能 处 
于 状态 空间 中 的 位 置 的 信念 。 信 念 空 间 是 完全 可 观测 
HJ (Agent 确切 知道 其 信念 ) ， 因 此 POMDP 可 以 变换 
成 信念 空间 上 的 MDP, FÆ VI 和 PL 算法 便 可 用 了 。 
言 念 空间 以 指数 级 大 于 状态 空间 ， 且 是 连续 的 。 因 
此 ， 只 有 小 状态 空间 上 的 POMDP 可 以 用 这 种 方式 有 
效 处 理 。 还 有 些 逼 近 方 法 ， 见 参考 文献 [9.4] 的 第 
17 章 。 


9.3.4 机 器 人 规划 


机 器 人 规划 (或 基于 规划 的 机 器 人 控制 ) 一 词 
在 AL 领域 中 是 指 在 机 器 人 (通常 指 自主 移动 机 器 
A) 控制 软件 中 使 用 前 述 规划 方法 ， 并 非 意 味 着 要 
蔡 换 机 器 人 技术 中 现 有 的 运动 或 路 径 规划 方法 (S 
见 第 5 章 、 第 26 章 和 第 35 章 ) ， 而 是 对 更 一 般 的 动 
作 规 划 做 些 补充 。 在 机 器 人 控制 中 使 用 规划 有 若干 目 
的 ， 无 论 这 些 规划 是 由 机 器 人 在 线 自动 生成 的 ， 还 是 
从 规划 库 中 取出 的 。 提 供 一 种 高 度 细 化 的 机 器 人 操作 
描述 ， 可 用 于 优化 全 部 行为 ， 可 用 于 如 任务 级 遥 操 作 
一 样 与 人 交互 ， 可 用 于 如 多 机 器 人 协调 (参见 第 40 
章 ) 中 的 一 样 与 伙伴 机 器 人 通信 ， 可 用 于 在 高 粒度 
块 中 学 习 复 杂 的 动作 结构 ， 可 用 于 根据 环境 变化 自 适 


第 9 章 ， 机 器 人 智能 推理 方法 177 


应 行为 ， 也 可 在 不 同 的 应 用 规模 上 通过 为 程序 员 提 供 
种 有 意义 的 抽象 层 而 用 于 机 器 人 控制 编码 工程 。 参 
考 文献 [9.27] 第 20 章 阐述 了 这 些 目的 ， 参 考 文献 
[9.46] 收集 了 跨越 这 些 目的 的 研究 论文 ， 参 考 文献 
[9.33] 第 5 章 对 本 领域 最 近 的 应 用 前 景 进 行 了 
展望 。 

由 于 机 右 人 动作 规划 的 目的 和 抽象 级 别 多 种 多 
样 ， 没 有 哪 一 种 单一 的 规划 方法 能 与 之 完全 对 应 上 ， 
当然 任何 一 种 规划 方法 又 都 有 用 。 于 是 ， 机 器 人 规划 
一 词 通常 被 按照 参考 文献 [9.47] 中 表述 的 宽泛 含义 
使 用 ， 即 “是 机 器 人 程序 的 一 部 分 ， 机 器 人 对 其 未 来 
的 执行 进行 显示 的 推理 ” 。 无 论 机 器 人 采用 哪 种 规划 ， 
对 闭环 执行 和 监控 都 有 需求 ， 从 规划 方法 学 的 角度 看 ， 
机 器 人 规划 的 内 容 就 源 自 这 些 需 求 。 从 技术 上 讲 ， 这 
些 需求 形成 了 对 机 器 人 规划 的 约束 ， 尤 其 是 对 域 语言 、 
动作 形式 化 及 机 器 人 控制 体系 结构 的 约束 。 

给 定 规划 域 的 域 语言 通常 是 精心 地 手工 构建 
的 ， 因 为 粮 糕 的 设计 决策 可 能 使 同样 规划 右 的 规划 时 
间 有 着 天 壤 之 别 。 对 于 机 器 人 规划 ， 还 有 男 外 一 个 问 
题 : 命题 (至 少 那些 为 规划 生成 和 执行 监控 而 需 观 
测 的 命题 ) 需要 完全 依靠 传感器 数据 来 有 效 确定 。 

般 而 言 ， 这 便 是 AI 中 符号 接地 问题 ”'” (参见 
9.1 市 )。 目 前 解决 此 问题 最 务实 的 做 法 是 将 域 语言 
的 动态 部 分 限制 到 可 以 被 有 效 监 控 的 命题 上 。 

动作 形式 化 最 好 应 支持 规划 生成 和 执行 监控 ， 因 
此 要 有 足够 的 表达 能 力 ， 比 如 类 似 于 实时 规划 语言 ， 
此 外 还 要 有 足够 的 限制 以 对 规划 进行 有 效 推理 。 参 考 
文献 [9.48] 讨论 了 这 些 问题 ， 并 对 已 有 方法 进行 
了 较 小 范围 的 综述 。 

最 后 ， 机 器 人 控制 体系 结构 必须 确定 规划 过 程 和 
规划 结果 要 被 适当 地 集成 到 整个 机 器 人 控制 中 。 特 别 
是 来 自 新 近 规 划 (如果 有 ) 的 建议 与 来 自 其 他 控制 
组 件 (如 并 发 反应 行为 组 件 ) 的 任何 活动 必须 能 
效 协 商 ， 详 见 第 8 章 。 


9.4 机 器 人 学 习 


机 器 学 习 是 AI 研究 领域 中 最 受 关注 的 问题 之 一 ， 


技术 及 其 他 领域 中 广泛 使 用 的 学 习 方法 。 如 果 表 示 法 
是 概率 的 ， 就 采用 贝 叶 斯 推理 。 神 经 网 络 〈 基 于 生 
物 神 经 元 的 形式 模型 ) 涵盖 了 与 统计 学 习 相 关 的 数 
据 分 类 技术 。 

强化 学 习 是 另 一 种 在 机 器 人 中 比较 流行 的 学 习 方 
法 ， 它 与 MDP 和 动态 规划 密切 相关 。 它 主要 是 采用 
与 每 个 机 器 人 动作 关联 的 强化 信号 CRE) 来 对 正 
确 啊 应 进行 强化 。 

学 习 也 可 以 根据 系统 动作 后 是 否 有 教师 能 显 式 提 
HEMER ( 即 ， 能 对 系统 进行 奖惩 或 具有 系统 自 
身 性 能 可 用 。) 而 分 成 有 监督 和 无 监督 两 类 。 

本 届 综 述 了 机 器 人 领域 感 兴趣 的 最 重要 的 学 习 方 
法 。 学 习 在 机 器 人 控制 中 的 应 用 贯穿 本 书 始终 ， 如 第 
37 章 学 习 标 图 、 第 60 章 学 习 复 杂 的 马达 协调 模式 以 
及 第 61 章 的 演化 学 习 。 


9.4.1 归纳 逻辑 学 习 


归纳 逻辑 规划 (ILP)5 4 是 主要 的 有 监督 符号 
学 习 方 法 之 一 ， 它 是 基于 逻辑 表示 法 和 一 阶 逻 辑 推理 
的 ， 并 使 用 上 下 文 知识 ， 即 已 经 获得 的 知识 。ILP 的 
目标 是 给 定 返回 真 或 假 值 变 量 集 和 所 谓 的 背景 知识 来 
综合 (或 学 习 ) 逻辑 程序 ， 程 序 对 观测 形成 一 个 解 
释 。 这 些 程序 当然 不 是 唯一 的 。 因 此 ， 其 难点 在 于 寻 
找 与 数据 兼容 的 最 小 〈 充 分 必要 的 ) 程序 ， 即 对 正 
变量 返回 真 、 对 负 变 量 返 回 假 。 该 程序 也 必须 能 被 泛 
化 ， 即 应 用 到 新 的 实例 上 时 能 产生 正确 答案 。 一 般 而 
言 ，IPL 并 不 容易 处 理 。 参 考 文献 [9.4] 中 的 第 
19. 5 节 对 此 作 了 介绍 。 


9.4.2 统计 学 习 与 神经 网 络 


统计 学 习 被 广泛 用 于 机 器 人 和 计算 机 视觉 领域 ， 
涵盖 了 诸如 贝 叶 斯 学 习 、 核 方法 和 神经 网 络 等 若干 技 
术 。 它 以 从 数据 中 学 习 模 型 为 目标 将 模式 划分 到 类 别 
中 ， 数 据 被 看 成 随机 变量 ， 数 据 的 值 为 模型 提供 了 条 
样 。 首 先 要 有 一 个 训练 阶段 ， 此 阶段 中 将 数据 集 及 关 
联 标 签 提 呈 给 算法 (有 监督 学 习 )。 然 后 算法 会 自己 
对 数据 进行 标注 。 训 练 阶段 的 目标 是 最 小 化 分 类 误差 
(或 风险 ,或 期 望 损失 )。 推 荐 阅读 参考 文献 [9.4] 


学 习 与 智能 之 间 的 联系 是 显而易见 的 。 学 习 程 序 的 首 
例 是 1959 年 Samuel 编写 的 西洋 棋 程 序 。 学 习 的 定义 
本 身 与 智能 的 定义 一 样 具 有 一 般 性 ， 它 基本 上 可 以 表 
述 为 基于 经 验 改 善 系统 自身 性 能 或 知识 的 能 力 。 在 
AI 中 ， 典 型 的 学 习 方法 主要 是 通过 演绎 、 归 纳 或 类 
比方 法 操作 符号 表示 以 产生 新 知识 。 统 计 学 习 涵盖 了 
数据 分 类 方法 〈 即 从 样本 推导 模型 ) ， 这 是 在 机 器 人 


第 20 章 进 行 一 般 了 解 。 

贝 叶 斯 学 习 是 贝 叶 斯 规则 的 一 种 应 用 一 一 根据 给 
定数 据 计算 给 定 假设 (数据 所 属 的 类 别 标签 ) 的 概 
R, 训练 阶段 提供 数据 对 每 一 类 的 似 然 程 度 
P(d | Cj) ,分 类 还 需要 类 分 布 的 先 验 知识 P(C), XX 
样 才 能 应 用 贝 叶 斯 规则 。 贝 叶 斯 学 习 有 若干 变种 ， 如 
极 大 似 然 法 (ML) 和 期 望 最 大 化 算法 (EM) 。 贝 叶 
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斯 技术 具有 中 等 计算 耗费 ， 易 于 实现 ， 但 不 能 在 线 
学 习 。 

神经 网 络 (NN) 由 加 权 连 接 的 基本 计算 单元 
(神经 元 ) 构成 。 每 个 单元 计算 其 输入 的 加 权 和 ， 如 
果 大 于 给 定 阔 值 (常用 Sigmoid 函数 ) 则 激活 或 点 
火 ， 这 便 具备 了 分 类 器 的 基础 。 最 常用 的 前 馈 网 络 的 
基本 结构 包括 一 个 输入 层 、 一 个 或 多 个 隐 层 以 及 一 个 
输出 层 。 通 过 连接 权重 ，NN 的 输出 便 构 成 其 输入 的 
函数 。NN 的 训练 就 是 调整 权重 以 对 数据 正确 分 类 
(有 监督 学 习 )。 与 贝 叶 斯 学 习 相 比 ， 神 经 网 络 没有 
洞察 分 类 器 的 内 部 ， 但 可 以 在 线 学 习 。 


9.4.3 强化 学 习 


强化 学 习 (RL) 是 一 种 通过 对 环境 施加 动作 并 
由 环境 反馈 奖赏 信号 的 无 监督 学 习 方 法 。 参 考 文献 
[9.50] 是 很 重要 RL 文献， 参考 文献 [9.4] 中 的 第 
21 章 也 有 一 般 性 介绍 。 在 RL A, LAE A XX, Agent 的 
目标 是 学 习 最 佳 策略 ， 即 达到 给 定 目 标的 动作 序列 。 
为 此 ， 必 须 最 大 化 累积 奖赏 值 ，RL 的 形式 框架 因此 
与 MDP 的 相同 。 机 器 人 在 集合 5 中 感知 (有 时 是 部 
分 感知 ) 环境 状态 ， 并 能 完成 集合 4 中 动作 ， 这 些 
动作 的 序列 便 形成 策略 7。 从 一 个 状态 执行 一 个 给 定 动 
作 到 下 一 个 状态 有 一 个 转移 概率 P(s,,, =s | s,,a)。 机 
器 人 努力 最 大 化 一 个 值 函 数 V,，V 表示 奖赏 值 7 随时 
间 累 积 的 期 望 。Bellman 方程 是 表达 值 函 数 并 使 最 优 
策略 7 “能够 学 习 的 基本 方程 。 


v* (s) = max[r(s a) y > PG' |s,a)V™*(s') ] 


S 


(9.1) 
HF, r(s, a) 为 立即 奖赏 ,折扣 因子 y 将 未 来 的 预 


期 奖赏 纳入 考虑 范围 。Q- 学 习 ””" 是 计算 最 优 策略 
的 一 个 变种 ， 其 思想 是 学 习 动 作 的 值 而 不 是 状态 
的 值 。 

大 部 分 RL 研究 工作 都 假定 动作 空间 是 离散 的 ， 
已 给 出 的 学 习 过 程 本 身 的 形式 并 不 能 直接 应 用 于 连续 
动作 空间 。 要 将 RL 应 用 于 连续 空间 ， 一 种 常用 的 做 
法 是 采样 。 


9.5 结论 与 扩展 阅读 


自从 AI 轿 露 头角 那天 起 ， 便 将 自主 机 器 人 列 入 
其 研究 日 程 。 在 20 世纪 90 年 代 ， 当 移动 机 器 人 平台 
广泛 使 用 且 价 格 可 以 接受 时 ， 很 多 实验 室 完 成 了 最 初 


为 Agent 的 计算 模型 (包括 感知 、 推 理 和 动作 执行 ) 
提供 一 个 有 用 的 试验 床 ， 因 为 机 器 人 能 在 完整 的 集成 
中 检验 这 些 模型 。 

这 与 AI 对 机 器 人 技术 的 长 远 观 点 相似 ， 都 是 要 
开发 能 为 智能 自主 机 器 人 闭环 控制 器 有 点 贡献 的 方法 
和 工具 。 但 如 今 AI 推理 方法 对 机 器 人 技术 的 贡献 是 
什么 呢 ? 

这 里 已 经 学 到 了 两 点 体会 。 第 一 ， 已 经 介绍 过 的 推 
理 方法 十 分 易 懂 且 高 效 ， 目 前 已 能 够 安全 且 有 用 地 用 作 
机 器 人 Agent 闭环 控制 的 一 部 分 。RoboCup 中 型 足球 联 
赛 便 是 很 壮观 的 一 个 例子 , 美国 国家 航空 航天 局 
(NASA) 远程 Agent 任务 “” 自主 控制 功能 是 另外 一 例 。 
第 二 ,感知 、( 基 于 符号 的 ) 推理 和 动作 执行 的 
完全 闭环 集成 需要 解决 符号 接地 问题 *" (其 中 的 真 
实 部 分 ) 。 即 ， 必 须 理解 机 器 人 如 何 能 按照 用 于 推理 
和 动作 规划 的 语义 范畴 去 感知 环境 。 理 解 符 号 接地 的 
过 程 完全 人 处 于 AI 及 与 此 有 关 的 所 有 认 知 科学 的 大 问 
题 之 中 。 因 此 机 器 人 技术 最 好 别 再 等 待 AI 先行 找到 
一 般 的 解决 方案 。 这 期 间 ， 机 器 人 可 以 在 闭环 控制 中 
使 用 AI 推理 方法 ， 只 要 有 用 就 行 ， 别 管 所 需 的 数据 
在 哪里 可 以 得 到 。 

为 总 结 本 章 ， 我们 回 到 机 器 人 控制 体系 结构 的 问 
题 上 ， 突 出 功能 集成 与 物理 集成 的 基本 观点 。 为 了 这 
一 回顾 之 目的 ,我们 将 推理 看 成 是 一 种 或 一 套 必须 依 
赖 以 下 来 源 提供 信息 的 方法 : 第 一 ， 域 建 模 者 
(A); 第 二 ,为 以 符号 形式 提供 域 当前 状态 的 最 新 
信息 而 进行 的 在 线 感知 ，( 可 能 还 会 有 ) B=, 泛 化 
既往 经 验 帮 助 对 自身 进行 识别 或 推理 的 学 习 带 。 这 种 
观点 实际 上 有 点 鼠 目 寸 光 。 一 个 完全 集成 的 机 器 人 推 
理 需 应 该 通过 提供 假设 来 帮助 其 他 模块 ， 如 ， 感 知 模 
块 可 能 正在 其 传 感 数据 中 找 什 么 〈 如 果 你 告诉 我 你 
已 经 确定 了 水 槽 和 洗 碗 机 ， 那 么 我 告诉 你 ， 我 们 可 能 
会 在 厨房 里 ,你 可 以 密切 注意 冰箱 )。 推 理 和 感知 的 
双向 集成 目前 已 经 超越 了 最 先进 的 机 器 人 技术 ,正在 
成 为 研究 热点 ， 其 灵感 可 能 源 自 认 知 视觉 的 相关 工 
作 ， 参 考 文献 【9.53] 收集 了 这 方面 近年 发 表 的 
论文 。 

为 了 更 全 面 地 了 解 本 章 提 到 的 各 种 方法 及 AI 中 
的 其 余 方 法 ， 推 荐 阅读 AI 教材 ， 其 中 由 Russell 和 
Norvig 的 著作 ”1 目前 正 被 广泛 使 用 。 参考 文献 
[9.5] 专门 介绍 了 近年 的 知识 表示 方法 及 相关 问题 ， 
推荐 一 读 。 在 第 一 手 资料 来 源 中 ， 特 别 要 提 一 下 两 部 
HAT), Artificial Intelligence 和 Journal of Artificial Intelli- 
gence Research ( JAIR) 3.%]， 其 内 容 均 能 很 好 地 覆盖 


的 实验 。AI 对 待机 器 人 技术 的 态度 非常 明确 ， 就 是 


这 里 探讨 的 话题 。International Joint Conferences on 


第 9 章 ”机 器 人 智能 推理 方法 


179 


Artificial Intelligence (1JCA1) 是 AI 领域 最 主要 的 国际 
会 议 ， 两 年 一 次 ， 每 着 奇数 年 召开 。 


9.1 


9.2 


9.3 


9.4 


9.5 


9.6 


9.7 


9.8 


9.9 


9.10 


9.11 


9.12 


9.13 


9.14 


9.15 


9.16 


9.17 


9.18 


9.19 


9.20 


S. Harnad: The symbol grounding problem, Physica 
D 42, 335-346 (1990) 

S. Coradeschi, A. Saffiotti: An introduction to the an- 
choring problem, Robot. Auton. Syst. 43(2-3), 85-96 
(2003) 

F. Baader, D. Calvanese, D. McGuinness, D. Nardi, 
P. Patel-Schneider (Eds.): The Description Logic 
Handbook (Cambridge Univ. Press, Cambridge 2003) 
S. Russell, P. Norvig: Artificial Intelligence: A Modern 
Approach, 2nd edn. (Prentice Hall, Englewood Cliffs 
2003) 

R.J. Brachman, H.J. Levesque: Knowledge Repre- 
sentation and Reasoning (Morgan Kaufmann, San 
Francisco 2004) 

W.V.0. Quine: Methods of Logic, 4th edn. (Harvard 
Univ. Press, Cambridge 1955) 

Z. Manna, R. Waldinger: The Deductive Foundations 
of Computer Programming: A One-Volume Version 
of “The Logical Basis for Computer Programming” 
(Addison-Wesley, Reading 1993) 

W. Hodges: Elementary predicate logic. In: Hand- 
book of Philosophical Logic, Vol. |, ed. by D. Gabbay, 
F. Guenthner (D. Reidel, Dordrecht 1983) 

A. Robinson, A. Voronkov (Eds.): Handbook of Auto- 
mated Reasoning (Elsevier Science, Amsterdam 2001) 
M. Davis, G. Logemann, D. Loveland: A machine 
program for theorem proving, Commun. ACM 5(7), 
394-397 (1962) 

J. Franco, H. Kautz, H. Kleine Büning, H. v. Maaren, 
E. Speckenmeyer, B. Selman (Eds.): Special issue: 
theory and applications of satisfiability testing, Ann. 
Math. Artif. Intell. 43, 1-365 (2005) 

The Web Ontology Language OWL. http://www.w3. 
org/TR/owl-features/ 

G. Antoniou, F. v.Harmelen: A Semantic Web Primer 
(MIT Press, Cambridge 2004) 

K.L. Chung, F. AitSahila: Elementary Probability The- 
ory (Springer, Berlin 2003) 

J. Pearl: Probabilistic Reasoning in Intelligent Sys- 
tems (Morgan Kaufmann, San Mateo 1988) 

R. Brooks: Intelligence without representation, Artif. 
Intell. 47, 139-159 (1991) 

J. McCarthy, P. Hayes: Some philosophical prob- 
lems from the standpoint of artificial intelligence, 
Machine Intell. 4, 463-507 (1969) 

H. Levesque, R. Reiter, Y. Lespérance, F. Lin, 
R. Scherl: Golog: a logic programming language for 
dynamic domains, J. Logic Programm. 31, 59-83 
(1997) 

M. Shanahan, M. Witkowski: High-level robot con- 
trol through logic, ATAL '00, 7th Intl. Workshop 
Intell. Agents VII. Agent Theories Architectures and 
Languages 2000 (Springer, Berlin 2001) pp.104— 


121 
M. Thielscher: Reasoning Robots. The Art and Science 


of Programming Robotic Agents (Springer, Berlin 
2005) 


9.21 


9.22 


9.21 


9.34 


9.41 


9.42 


A. Saffiotti, K. Konolige, E.H. Ruspini: A multivalued 
logic approach to integrating planning and control, 
J. Artif. Intell. 76, 481-526 (1995) 

R.J. Firby: An investigation into reactive planning 
in complex domains, AAAI 1987 (Morgan Kaufmann, 
San Mateo 1987) pp. 202-206 

M.P. Georgeff, A.L. Lansky: Reactive Reasoning and 
Planning, AAAI 1987 (Morgan Kaufmann, San Mateo 
1987) 

M.P. Georgeff, F.F. Ingrand: Decision-making in an 
embedded reasoning system, WCAl 1989 (Morgan 
Kaufmann, San Mateo 1989) 

M. Boddy, T.L. Dean: Solving time-dependent plan- 
ning problems, IJCAI 1989 (Morgan Kaufmann, San 
Mateo 1989) 

S. Zilberstein: Operational rationality through com- 
pilation of anytime algorithms, Al Mag. 16(2), 79-80 
(1995) 

M. Ghallab, D. Nau, P. Traverso: Automated Plan- 
ning: Theory and Practice (Morgan Kaufmann, San 
Francisco 2004) 

R.E. Fikes, N.J. Nilsson: strips: a new approach to 
theorem proving in problem solving, J. Artif. Intell. 
2, 189-208 (1971) 

R.E. Fikes, P.E. Hart, N.J. Nilsson: Learning and ex- 
ecuting generalized robot plans, J. Artif. Intell. 3, 
251-288 (1972) 

N.J. Nilsson: Shakey the Robot. SRI International, 
Tech. Note TN 323, 1984. www..ai.sri.com/shakey/ 

J. Rintanen, J. Hoffmann: An overview of recent 
algorithms for Al planning, KI 15(2), 5-11 (2001) 
PLANET: Euopean Network of Excellence in Al Plan- 
ning. http://www. planet-noe.org/ 

PLANET Technological Roadmap on Al Planning and 
Scheduling. http: //www.planet-noe.org/service/ 
Resources/Roadmap/Roadmap2.pdf. 2003 

D. McDermott, M. Ghallab, A. Howe, A. Ram, M. 
Veloso, D. S. Weld, D. E. Wilkins: PDDL - The 
Planning Domain Definition Language, Tech Re- 
port, Vol. CVC TR-98-003/DCS TR-1165 (Yale Center 
for Computational Vision and Control, New Haven 
1998) 

M. Fox, D. Long: PDDI2.1: an extension to PDDL for 
expressing temporal planning domains, J. Artif. In- 
tell. Res. 20, 61-124 (2003) 

T. Bylander: The computational complexity of 
propositional strips planning, J. Artif. Intell. 69, 
165-204 (1994) 

D. McAllester, D. Rosenblitt: Systematic nonlinear 
planning, AAAI 1991 (Morgan Kaufmann, San Mateo 
1991) 

D. Wilkins: Domain-independent planning: repre- 
sentation and plan generation, J. Artif. Intell. 22, 
269-301 (1984) 

D.S. Nau, T.C. Au, 0. Ilghami, U. Kuter, M. Mur- 
dock, D. Wu, F. Yaman: Shop2: an HTN plan- 
ning system, J. Artif. Intell. Res. 20, 379-404 
(2003) 

A.L. Blum, M.L. Furst: Fast planning through plan 
graph analysis, J. Artif. Intell. 90, 281-300 (1997) 

C. Green: Application of theorem proving to problem 
solving, UCAI 1969 (Morgan Kaufmann, San Mateo 
1969) 

P. Doherty, J. Kvarnstróm: TALplanner: a temporal 


180 第 1 篇 ”机 器 人 学 基础 
logic based planner, Al Mag. 22(3), 95-102 (2001) 9.49 N. Lavrac, S. Dzeroski: Inductive Logic Programming: 
9.43 H. Kautz, B. Selman: Unifying SAT-based and graph- Techniques and Applications (Ellis Horwood, New 
based planning, UCAI, Stockholm 1999 (Morgan York 1994) 
Kaufmann, San Mateo 1999) 9.50 R.S. Sutton, A.G. Barto: Reinforcement Learning: An 
9.44 S. Thrun, W. Burgard, D. Fox: Probabilistic Robotics Introduction (MIT Press, Cambridge 1998) 
(MIT Press, Cambridge 2005) 9.51 CJ. Watkins: Models of Delayed Reinforcement 
9.45 B. Bonet, H. Geffner: Planning with incomplete in- Learning. Ph.D. Thesis (Cambridge Univ., Cambridge 
formation as heuristic search in belief space, AIPS 1989) 
2000 (AAAI, Menlo Park 2000) 9.52 N. Muscettola, P. Nayak, B. Pell, B.C. Williams: Re- 
9.46 MM. Beetz, J. Hertzberg, M. Ghallab, M.E. Pollack mote Agent: to boldly go where no AI system has 
(Eds.): Advances in Plan-Based Control of Robotic gone before, J. Artif. Intell. 103, 5-47 (1998) 
Agents, Vol. 2466 (Springer, Berlin 2002) 9.53 H.I. Christensen, H.H. Nagel (Eds.): Cognitive Vision 
9.47 D. McDermott: Robot planning, Al Mag. 13(2), 55-79 Systems - Sampling the Spectrum of Approaches 
(1992) LNCS (Springer, Berlin 2006) 
9.48 M. Beetz: Plan representation for robotic agents, 9.54 J. Artif. Intell. Res. http://www.jair.org 


AIPS, Toulouse 2002 (AAAI, Menlo Park 2002) 


第 2 篇 机 器 人 结构 


Frank C. Park 编辑 


第 10 章 性 能 评价 与 设计 标准 

Jorge Angeles, ， 加 拿 大 蒙特 利 尔 

Frank C. Park， 韩 国 首尔 

第 11 章 ”运动 学 元 余 机 械 臂 

Stefano Chiaverini, AFAIK PIA 

Giuseppe Oriolo ， 意 大 利 罗 马 

Ian D. Walker， 美 国 克 莱 姆 森 

第 12 章 并 联机 器 人 

Jean-Pierre Merlet， 法 国 苏 菲 亚 - 安 提 波 利 斯 
Clément Gosselin, ， 加 拿 大 魁北克 


第 13 章 具有 柔性 元 件 的 机 器 人 
Alessandro De Luca， 意 大 利 罗马 
Wayne Book ， 美 国 亚特兰大 

第 14 章 ”模型 识别 
John Hollerbach ， 美 国 盐湖 城 
Wisama Khalil， 法 国 南 特 
Maxime Gautier， 法 国 南 特 


第 15 章 机 器 人 手 
Claudio Melchiorri， 意 大 利 博洛尼亚 
Makoto Kaneko, H AKER 


第 16 章 有 腿 机 器 人 

Shuuji Kajita， 日 本 筑波 

Bernard Espiau， 法 国 圣 伊 斯 米 尔 
第 17 章 轮 式 机 器 人 
Guy Campion, HEPIE 
Woojin Chung， 昔 国 首尔 

第 18 章 ”微型 和 纳米 机 器 人 
Bradley J. Nelson, ， 瑞 士 苏 黎 世 
Lixin Dong， 瑞 士 苏 黎 志 
Fumihito Arai， 日 本 仙台 


182 第 2 篇 


机 器 人 结构 


本 篇 介绍 机 器 人 结构 ， 主 要 关注 于 机 器 人 的 设 
计 、 建 模 、 动 作 规划 ， 以 及 对 于 机 器 人 物理 运动 的 控 
制 。 我 们 首先 会 想到 那些 带 有 臂 、 腿 以 及 手 的 机 器 人 
结构 ， 与 此 同时 ， 还 会 想到 轮 式 的 车 辆 和 平台 ， 并 将 
微米 和 纳米 级 的 机 器 人 也 加 入 到 机 融 人 结构 中 。 即 使 
是 对 于 像 手 臂 一 样 的 最 简单 的 机 器 人 部 件 ， 考 虑 到 大 
量 的 连 杆 和 传动 机 构 形 式 ， 在 运动 机 构 中 存在 着 各 种 
各 样 的 封闭 运动 链 ， 以 及 关节 连接 的 灵活 性 ， 那 么 让 


准 。 本 章 主 要 对 控制 区 间 的 逆向 运动 匈 余 解决 方案 进 
行 了 讨论 ， 其 中 涉及 了 从 仅 有 少数 运动 元 余 自 由 度 到 
可 以 被 运动 模型 认为 是 连续 曲线 的 大 量 的 宛 余 控 制 
情况 。 

第 12 章 并 联机 器 人 ， 介 绍 了 仿真 机 械 运动 学 和 
动力 学 ,例如 著名 的 Stewart- Gough 平台 。 并 联机 构 
包含 闭环 的 运动 结构 ， 还 有 诸如 那些 与 研究 串联 机 构 
相差 很 大 的 研究 方法 。 本 章 主要 讨论 了 多 种 主题 ， 从 


人 惊奇 的 形形色色 的 设计 方案 也 是 完全 有 可 能 的 。 对 
于 这 些 结构 的 有 效 模型 和 规划 控制 算法 将 是 更 加 具有 
挑战 性 的 问题 。 

本 篇 的 主题 不 仅仅 对 于 建立 机 器 人 本 身 尤 为 重 
要 ， 对 于 建立 设计 和 控制 动作 ， 按 照 指 令 进行 操纵 方 
面 也 至 关 重 要 。 因 此 ， 本 篇 与 机 器 人 学 基础 〈 第 1 
篇 ) 的 联系 是 显然 的 ， 尤 其 是 第 1 篇 中 关于 运动 学 
(第 1 章 ) 、 动 力学 (第 2 章 )， 以 及 机 构 与 驱动 (第 
3 章 ) 的 章节 。 将 机 器 人 与 其 他 研究 智能 的 学 科 最 终 
区 别 开 的 因素 就 机 器 人 定义 方面 而 言 ， 是 机 器 人 本 号 
需要 一 种 运动 表现 ; 在 机 器 人 拓展 应 用 方面 ， 是 机 央 

需要 与 环境 交互 来 产生 它 的 动作 。 本 篇 所 处 理 的 问 
题 可 以 被 认为 是 组 成 机 器 人 整体 研究 的 一 个 最 基础 
层次 。 
正如 仅仅 通过 简化 后 的 模型 去 了 解 人 类 的 智力 和 
对 人 类 身体 的 远 距 离 探知 一 样 ， 分 解 开 那些 结构 的 各 
个 零件 而 不 去 讨论 其 内 部 的 连接 和 相互 影响 是 非常 困 
难 的 。 比 如 说 ， 关 于 怎样 设置 坐标 系 以 及 描述 运动 
(第 3 篇 )， 怎 样 抓 取 和 控制 物体 (第 4 篇 ) ， 以 及 怎 
样 教会 复杂 的 机 器 人 去 学 习 (第 5 篇 ) 都 不 可 避免 
的 需要 考虑 到 机 器 人 的 物理 结构 。 专 门 为 多 种 用 途 和 
环境 所 设计 的 机 器 人 【第 6 篇 )， 尤 其 是 那些 专门 针 
对 直接 与 人 接触 的 那些 机 器 人 【第 7 篇 ) ， 也 自然 需 
要 考虑 到 机 器 人 的 物理 结构 。 

本 篇 各 章 的 主要 内 容 包括 : 

第 10 章 性 能 评价 与 设计 标准 ， 提 供 了 一 个 关于 
机 器 人 设计 过 程 的 简 洗 概述 ， 以 及 关于 设计 结构 工具 
的 评价 标准 和 机 器 人 运动 表现 的 评价 体系 的 简单 调 
研 。 例 如 工作 空间 、 局 部 和 全 局 灵活 性 ， 以 及 弹性 静 
力学 和 弹性 动力 学 的 表现 评价 ， 它 们 不 仅 决 定 了 机 带 
人 的 拓扑 结构 以 及 物理 维度 ， 而 且 还 能 对 诸如 工件 放 
置 和 动态 元 余 自 由 度 解决 方案 起 到 一 定 的 作用 。 

第 11 章 运动 学 元 余 机 械 臂 ， 处 理 了 宛 余 自由 度 
的 运动 的 产生 和 控制 的 问题 。 运 动 学 的 元 余 使 机 器 人 
具有 更 高 程度 的 灵活 性 ， 这 样 的 灵活 性 可 以 用 于 避免 
奇异 点 、 关 节 限 制 和 工作 空间 障碍 等 方面 ， 同 时 还 能 
够 最 小 化 驱动 转 矩 、 能 量 以 及 其 他 适应 性 运动 执行 标 
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并 联机 构 的 运动 合成 、 正 向 和 逆向 运动 学 ， 到 对 于 其 
特殊 行为 、 工 作 位 置 特性 、 静 态 和 动态 分 析 以 及 实际 
涉及 问题 的 探究 。 

第 13 章 具 有 和 柔性 元 件 的 机 器 人 人， 讨论 了 动态 模 
型 和 对 于 由 柔性 关节 和 连 杆 组 成 的 机 器 人 的 控制 。 因 
为 对 于 柔性 关节 和 和 柔性 连 杆 ， 两 者 研究 方法 在 结构 上 
是 不 同 的 ， 所 以 这 一 章 主要 建立 在 这 两 种 柔性 模式 的 
相互 独立 研究 基础 上 。 这 种 方法 可 以 扩展 到 关节 和 连 
杆 都 具有 柔性 的 机 器 人 中 ， 其 至 是 两 者 同时 在 相互 动 
态 影响 的 实例 中 。 本 章 中 还 给 出 了 工业 机 器 人 中 柔性 
的 典型 来 源 。 

第 14 章 模型 识别 ， 讨 论 了 确定 机 器 人 控制 系统 
的 动态 内 部 参数 设 定 的 方法 。 对 于 动态 的 测量 ， 首 要 
目的 是 确定 几何 的 D-H 参数 或 者 运动 学 方程 ， 主 要 
通过 测量 关节 的 组 合 以 及 不 同 姿势 下 的 运动 极限 点 。 
另 一 方面 的 内 部 参数 是 通过 在 执行 一 段 轨迹 过 程 中 测 
量 一 个 或 多 个 关节 的 力 和 力矩 的 方式 进行 分 析 的 。 这 
样 的 动态 和 内 部 参数 定义 可 以 被 转换 为 对 于 常规 结构 
的 最 小 二 乘法 分 析 ， 也 就 是 说 常规 结构 的 关于 定义 的 
参数 、 测 量 方式 的 充分 性 ， 以 及 数值 鲁 棒 性 都 是 由 动 
态 和 内 部 参数 所 确定 和 影响 的 。 本 章 将 就 这 些 问 题 展 
开 讨 论 。 
第 15 章 机 器 人 手 ， 介 绍 机 器 人 手 设 计 、 建 模 和 
控制 背后 所 涉及 的 主要 原理 问题 。 从 讨论 拟人 化 程度 
和 机 械 手 灵巧 性 特点 开始 ， 本 章 分 析 了 机 器 人 手相 关 
设计 问题 、 驱 动 、 传 动 架 构 ， 以 及 可 行 的 传 感 技术 
等 。 机 器 人 手 控制 和 动态 建 模 之 所 以 困难 ， 不 仅仅 是 
因为 复杂 的 运动 学 结构 ， 还 有 那些 柔性 传动 元 件 。 本 
章 对 这 些 问题 也 作 了 专门 的 介绍 。 

第 16 章 有 腿 机 器 人 ， 主 要 讨论 了 关于 设计 、 分 
析 、 控 制 有 腿 机 器 人 方面 的 大 量 问 题 。 以 有 腿 机 器 人 
发 展 的 历史 作为 开端 ， 本 章 提供 了 回转 行走 分 析 ， 以 
及 建立 在 前 进 动力 和 ZMP (BR) 基础 上 的 双 
足 机 器 人 的 控制 。 与 此 同时 ， 例 如 模拟 哺乳 动物 的 四 
足 机 器 人 这 样 的 多 足 机 器 人 也 在 本 章 中 进行 了 讨论 。 
更 进一步 ， 混 合 的 由 腿 、 手 和 轮 式 结构 共同 组 成 的 机 
器 人 、 绳 索 行走 机 器 人 ， 甚 至 是 能 够 攀 怜 墙壁 的 有 腿 
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机 需 人 都 将 在 本 章 中 进行 讨论 。 前 微型 和 纳米 机 器 人 的 现状 的 概述 。 前 一 部 分 具体 描 
第 17 章 轮 式 机 器 人 ， 提 供 了 一 个 关于 轮 式 机 器 。 述 了 在 毫米 和 微米 级 别 的 机 器 人 对 于 物体 的 控制 ， 以 
人 普遍 上 且 便于 理解 的 描述 。 这 一 童 首先 讨论 了 基于 轮 ”及 在 这 一 个 尺度 空间 内 对 于 自主 机 器 人 结构 的 设计 和 
式 结构 的 机 器 人 的 运动 性 ， 以 及 其 运动 约束 的 特性 。 ”实现 (纳米 机 器 人 也 是 应 用 同样 的 定义 ， 只 是 其 尺 
本 前 还 论述 了 运动 和 动力 状态 的 空间 模型 ， 以 及 轮 式 ”十 维度 被 限制 在 纳米 的 程度 以 内 )。 概 述 了 尺度 效 
机 器 人 的 结构 特点 。 这 些 特点 主要 包括 : 控制 能 力 、 应、 驱动 ， 以 及 在 此 尺寸 级 别 内 的 传 感 和 制造 问题 。 
非 完 整 性 以 及 稳定 性 。 本 章 还 讨论 了 在 非 线性 控制 中 同时 ,还 论述 了 微型 结构 、 生 物 科学 以 及 对 于 微米 和 
的 反馈 线性 化 ， 以 及 基于 车 轮 个 数 和 形式 的 不 同 的 机 ”纳米 级 的 电子 机 械 系统 的 制造 和 特性 在 现实 中 的 应 用 
器 人 结构 分 类 等 方面 的 问题 。 问题 。 

第 18 章 微 型 和 纳米 机 器 人 ， 提 供 了 一 个 关于 当 
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本 前 主 要 介绍 机 器 人 的 设计 ， 重 点 是 捉 联结 构 
机 融 人 。 在 开始 部 分 提出 一 个 分 阶段 的 设计 流程 ， 
然后 介绍 机 器 人 设计 中 需 考 虑 的 主要 因素 ， 包 括 工 
作 空 间 几 何 特 性 、 动 态 静 力学 、 动 力学 、 静 弹性 和 
动弹 性 指标 。 为 此 ， 这 些 概念 所 需 的 数学 知识 也 被 
简要 地 介绍 以 使 本 章 更 易 理解 。 

我 们 总 结 部 分 在 机 咒 人 机 械 设计 和 性 能 评价 中 
j 到 的 工具 和 指标 。 重 点 关注 主要 用 于 操作 任务 的 
机 融 人 和 串联 链 结构 。 并 联机 器 人 的 运动 学 在 第 
12 章 中 介绍 ， 轮 式 、 行 走 机 器 人 、 多 指 手 和 其 他 
特殊 结构 在 各 自 相 应 的 章 中 介绍 。 
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本 章 介绍 的 指标 和 工具 的 最 主要 用 途 是 机 器 人 
的 机 械 结构 设计 。 机 器 人 设计 和 普通 的 单 自 由 度 机 
构 设 计 的 差别 在 于 ， 后 者 只 完成 一 个 特定 的 任务 ， 
如 从 传送 带 上 拾 起 一 个 工件 并 把 它 放 到 托盘 上 ， 传 
送 带 是 与 机 构 同 步 的 ， 托 盘 是 静止 的 ， 工 件 应 放 到 
何 处 已 经 被 明确 定义 。 与 此 不 同 ， 机 械 手 不 只 完成 
一 个 特定 的 任务 ， 而 是 一 类 任务 ， 可 能 是 平面 、 球 
面 、 直 线 ， 或 如 选择 柔性 装配 机 械 辟 (SCARA) 能 
够 完成 的 动作 ， 也 被 称 为 Schonflies 位移， 等。 机 
器 人 设计 者 面临 的 挑战 是 机 器 人 将 执行 的 任务 的 不 
确定 性 。 设 计 标 准将 有 助 于 设计 者 处 理 这 些 不 确 
定性 


定性 
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给 定 一 系列 的 任务 ， 如 功能 要 求 和 更 具体 的 设计 
要 求 ， 设计 者 需要 设计 一 台 机 絮 人 满足 上 述 所 有 要 
求 。 设 计 过 程 包括 以 下 阶段 : 

1) 确定 机 械 结构 对 应 的 运动 链 的 拓扑 结构 。 我 
们 将 机 器 人 分 为 三 类 : 串联、 并联 和 混合 结构 。 然 后 
确定 各 子 链 间 的 关节 连接 形式 ， 最 常用 的 是 转动 式 和 
棱柱 式 。 近 年 来 ， 一 种 新 的 形式 也 被 广泛 使 用 ， 
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休 - 关 节 ， 两 杆 绕 平行 的 轴 转 动 相同 的 角 位 移 ， 导 致 
耦合 的 两 杆 实现 平移 ， 这 四 个 杆 构成 了 一 个 平行 四 边 
Weary 。 

2) 确定 各 杆 件 的 几何 尺 才 以 定义 机 器 人 结构 ， 
即 填写 Denavit- Hatenberg 参数 表 呈 31 来 满足 工作 空间 
要 求 。 尽 管 通常 关节 变量 也 被 包含 在 上 述 参数 中 ， 但 
关节 变量 并 不 影响 机 器 人 结构 ， 而 是 确定 机 器 人 
姿态 。 

3) 确定 各 杆 件 和 关节 的 结构 参数 以 满足 静态 负 
载 要 求 ， 负 载 包括 力 和 力矩 。 要 求 即 可 以 定义 为 最 大 
负载 情况 ， 也 可 以 定义 为 最 常见 工作 状态 ， 这 取决 于 
所 采用 的 设计 思路 。 

4) 确定 各 杆 件 和 关节 的 结构 参数 来 满足 动态 
负载 要 求 ， 负 载 包 括 杆 件 和 操作 对 象 共同 的 惯性 
效应 。 
5) 确定 整体 机 械 结构 的 动弹 性 参数 ， 包 括 执 行 
器 的 动态 特性 ， 以 避免 最 大 负载 条 件 或 最 常见 工作 条 
件 下 的 特定 共振 频率 。 

6) 针对 设计 中 确定 的 工作 条 件 选 择 执行 器 和 相 
应 的 机 械 传动 形式 ,来 适应 任务 的 不 确定 性 。 

上 述 过 程 应 依次 执行 : 首先， 基于 任务 系列 和 
工作 空间 的 形状 (UL 10.2.2 节 ) 确定 拓扑 结构 。 
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@ 基 于 对 工作 空间 的 要 求 ， 包 括 最 大 可 达 位 置 和 前 一 


平台 能 够 进行 纯 平 动 。Adept 技术 公司 报告 的 最 短 往 


阶段 定义 的 拓扑 结构 ， 确 定 杆 件 的 几何 尺寸 。@ 基 于 
上 述 杆 件 几 何 尺寸 确定 各 杆 件 和 关节 的 结构 参数 以 达 
到 满足 支撑 静态 负载 要 求 ( 除 并 联机 器 人 外 ， 其 他 
类 型 机 器 人 的 所 有 关节 都 是 主动 驱动 的 ， 并 联机 器 人 
不 在 本 章 的 讨论 范围 内 )。@ 基 于 上 述 由 静态 负载 条 
件 确定 的 杆 件 和 关节 结构 参数 ， 确 定 杆 件 的 质心 和 转 
动 惯量 矩阵 来 初步 评价 电动 机 力矩 需求 (这 种 评价 
是 初步 的 ， 因 为 执行 器 的 动态 特性 没有 被 考虑 ， 这 种 
负载 变化 是 显著 的 ， 即 使 对 所 有 执行 器 都 安装 在 机 座 
上 的 并 联机 器 人 ) 。 名 假设 杆 件 是 刚性 的 ， 关 节 具 有 
和 柔性， 根据 经 验 或 由 类 似 的 机 器 人 得 到 的 数据 ， 可 以 
得 到 机 器 人 的 动弹 性 模型 ， 其 在 一 系列 选择 的 姿态 下 
的 自然 模 态 和 频率 (结构 的 动态 行为 受 机 器 人 姿态 
影响 ) 可 以 由 科学 编程 语言 如 Matlab 或 计算 机 辅助 
工程 (CAE) 语言 如 Pro/Engineer 或 ANSYS 获得 。 
@@ 如 果 机 器 人 结构 的 频率 谱 可 以 被 接受 ， 设 计 者 可 以 
开始 选择 电动 机 ， 否 则 需要 重新 进行 参数 选择 ， 即 返 
回 步 又 3) 。 

尽管 一 个 设计 周期 可 以 按 上 述 过 程 完 成 ， 设 计 者 
现在 必须 协调 动弹 性 模型 和 电动 机 制造 商 提 供 的 结构 
和 惯量 数据 。 这 要 求 返回 阶段 5) 并 进行 新 一 轮 的 动 
弹性 分 析 。 显 然 ， 机 器 人 设计 过 程 和 普遍 的 工程 设计 
过 程 有 一 个 共同 点 : 它们 都 是 迭代 进行 的 "| 。 值 得 
注意 的 是 ,不 同 的 设计 阶段 中 有 不 同 的 主导 因素 ， 在 
很 大 程度 上 ， 这 些 因素 是 相互 独立 的 。 例 如 ， 拓 扑 结 
构 和 几何 特性 可 以 独立 于 电动 机 选择 。 当 然 ， 所 有 的 
因素 都 在 整体 设计 过 程 中 相互 影响 ,但 在 相当 多 的 设 
计 实 例 中 ,不 同 的 因素 并 不 相互 影响 ， 因 此 不 必须 采 
用 多 目标 设计 方法 。 换 言 之 ， 串 联机 器 人 的 最 优 设计 
可 以 通过 一 系列 的 单 目 标 最 优 设计 来 实现 。 再 次 重 
申 ， 最 后 的 结果 ， 电 动机 的 选择 ， 必 须 被 集成 到 整体 
数学 模型 中 以 验证 整体 的 性 能 。 一 个 工业 机 器 人 的 最 
优 设计 的 范例 见 参考 文献 [10.5]. 

只 有 当 部 件 的 物理 极限 被 突破 的 时 候 才 需要 返回 
阶段 1 进行 彻底 的 重 设计 。SCARA 系统 就 是 这 种 情 
况 。 当 前 工业 机 器 人 大 多 采用 串联 的 拓扑 结构 ， 除 了 
少量 例外 ， 如 Konig & Hartman RP- AH 系列 并 联结 构 
机 器 人 “4 ， 其 由 两 台 串 联 的 SCARA 系统 共用 一 个 
端 执行 器 。 对 更 短 的 往复 运动 时 间 (如 工业 测试 
周期 ， 见 10. 2.1 节 ) 的 需求 ， 促 使 工业 界 寻求 新 的 
结构 形式 。 现 在 ABB 机 器 人 公司 在 市 场 上 推出 并 联 
机 器 人 FlexPicker， 基 于 Clavel’s Delta HLA OT, 
在 前 三 个 自由 度 之 外 串联 添加 了 第 四 个 自由 度 。 
FlexPicker 整体 采用 并 联结 构 保 证 Delta 机 器 人 的 运动 


a 
M 


复 运动 周期 是 420ms， 负 载 为 2kg (VA Adept Cobra 
s600 串联 机 器 人 实现 ) ， 其 他 制造 商 还 报告 过 更 短 的 
时 间 。 

本 章 按照 上 述 机 器 人 设计 过 程 的 不 同 阶 段 的 次 
序 安排 。 注 意 到 拓扑 结构 和 几何 尺寸 的 选择 在 运动 
学 设计 过 程 中 紧密 相关 ， 我们 以 测试 工作 空间 要 求 
开始 :回顾 确定 运动 链 拓扑 结构 的 方法 ， 以 及 为 满 
足 工作 空间 要 求 的 几何 尺寸 。 然 后 详细 回顾 为 评价 
机 器 人 的 操作 能 力 而 提出 的 各 种 标准 ， 重 点 是 基于 
运动 学 和 动力 学 模型 的 关于 灵活 性 的 定量 描述 。 随 
后 检验 为 满足 静态 和 动态 负载 要 求 确定 杆 件 和 关节 
结构 参数 的 方法 。 最 后 讨论 动弹 性 特征 ， 执 行 器 和 
齿轮 的 尺寸 ， 其 中 考虑 到 机 器 人 的 固有 频率 特性 ， 
力 和 加 速度 要 求 。 


10.2 工作 空间 标准 


机 器 人 的 设计 过 程 中 一 个 首要 的 考虑 是 它 的 工作 
空间 需要 满足 一 系列 特性 要 求 ， 随 之 而 来 的 问题 是 用 
户 如 何 指定 这 些 特 性 。 

上 述 因素 基本 可 以 归于 Vijaykumar 等 人 提出 的 机 
DF az UO 。 将 机 械 手 视 为 解 耦 的 结构 ， 最 后 
三 个 转动 关节 的 轴线 交 于 一 点 ， 构 成 一 个 球形 腻 ， 轴 
的 交点 被 称 为 腕 中 心 。 对 于 这 种 结构 的 机 械 手 ,一 个 
操作 任务 可 以 被 分 解 为 位 置 和 姿态 子 任务 ， 由 前 3 个 
关节 构成 的 机 器 人 的 区 域 结构 负责 将 腕 中 心 放置 到 指 
定点 C(x, y, z); 随后 ， 局 部 结构 ， 即 腕 部 ， 保 证 
末端 操作 手 (EE) 获得 相对 机 座 坐 标 系 用 一 旋转 和 矩 
阵 描述 的 指定 姿态 。 

文献 中 大 部 分 确定 工作 空间 的 算法 都 采用 区 域 
结构 。 在 此 ， 我 们 需要 指出 不 考虑 物理 可 实现 性 的 
运动 链 的 工作 空间 和 实际 机 器 人 的 工作 空间 之 间 的 
区 别 。 对 于 前 者 ， 所 有 的 转动 关节 都 可 以 不 受 限 制 
地 绕 其 轴线 转动 ; 对 于 后 者 ， 关 节 限 制 是 存在 的 ， 
如 为 防止 导线 缠绕 。 在 机 器 人 设计 的 前 期 ， 可 以 暂 
不 考虑 关节 限制 ， 工 作 空 间 的 对 称 性 由 关节 类 型 
决定 。 如 果 第 一 个 关节 是 转动 关节 ， 整 个 工作 空 
间 绕 该 关节 的 轴线 对 称 ; ln RSS NE 
关节 ， 工 作 空 间 有 具有 延伸 对 称 性 ， 延 伸 的 方向 由 
该 关节 的 运动 方向 决定 。 理 论 上 棱柱 关节 可 以 无 
限 延 伸 ， 具 有 棱柱 关节 的 机 器 人 的 工作 空间 也 是 
无 限 延 伸 的 。 实 际 中 机 器 人 的 工作 空间 是 其 一 个 
子 空间 。 

对 于 并 联机 器 人 (将 在 14 章 详细 阐述 ) ， 总 体 
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上 ， 区 域 结构 的 意义 不 那么 清晰 。 显 示 其 工作 空间 的 
一 个 常用 方法 是 保持 其 运动 平台 (相当 于 串联 机 顺 
人 的 末端 操作 手 ) 在 一 个 固定 的 姿态 '" 。 在 设计 阶 
段 ， 并 联机 器 人 结构 各 采用 的 一 个 共同 特性 是 ， 用 相 
同 结构 且 对 称 放置 的 腿 联结 机 座 和 动 平台 。 每 条 腿 是 
具有 一 或 两 个 主动 自由 度 的 串联 运动 链 ， 其 余 的 自由 
度 均 为 被 动 自 由 度 。 这 类 机 器 人 的 工作 空间 也 具有 对 
称 性 ， 但 不 是 轴 对 称 。 对 称 性 由 腿 的 数目 和 驱动 关节 
的 类 型 确定 。 

回 到 串联 机 器 人 的 情况 ， 工 作 空间 可 以 被 定义 为 
下 列 两 种 情况 之 一 ， 除 了 在 一 些 Lebesgue 测量 值 为 
零 * 中 的 点 处 ， 几 乎 处 处 连续 的 拓扑 空间 艇 或 表面 。 
一 般 地 说 ， 在 表面 上 这 样 的 点 构成 一 条 曲线 ， 例 如 球 
面 上 的 子午 线 , 或 直线 上 一 些 孤 立 点 构成 一 个 集合 ， 
例如 实 轴 上 的 有 理 数 。 一 个 表面 型 工作 空间 的 例子 是 
Puma 机 需 人 ， 它 的 运动 链 如 图 10. 1 所 示 。 在 图 中 ， 
区 域 和 局 部 结构 可 以 被 很 容易 地 分 辨 ,前 者 处 于 完全 
展开 状态 。 机 器 人 的 工作 空间 可 以 按 下 列 步 又 获得 : 
首先 ， 当 机 器 人 处 于 图 10. 1 所 示 的 姿态 时 ， 锁 定 除 
关节 2 以 外 所 有 关节 ， 然 后 令 关节 2 绕 其 轴线 充分 旋 
转 ， 腕 的 中 心 C 构成 一 个 半径 为 RR 的 圆周 ， 也 就 是 C 
MEAR L 之 间 的 距离 。 圆 周 所 在 的 平面 垂直 于 直线 
L, SRP 1 的 轴线 五 之 间 的 距离 是 5,， 这 个 距离 
也 被 称 为 肩 部 偏 移 。 现 在 锁定 除 关节 1 以 外 所 有 关 
节 ， 然 后 机 器 人 绕 轴 线 L 转动 ， 结 果 如 图 10.2 中 的 
环形 。 这 个 表面 包围 的 内 部 就 是 布尔 操作 和-C 的 结 
果 ， 其 中 8 是 中 心 在 0, 半径 为 R 的 球体 ， 见 图 10.1， 
C 是 半径 为 6, 轴线 为 Z, 的 无 限 圆柱 体 。 需 要 指出 的 
是 ， 尽 管 这 个 工作 空间 可 以 用 简单 的 布尔 操作 产生 ， 
FPA HE IE A f(x, y, z) =0 WERSU Æ, WIK 
面 不 是 一 个 拓扑 空间 簇 。 


图 10.1 一 台 处 于 完全 展开 姿态 的 Puma 
机 器 人 ( 引 自 参考 文献 [10.11] ) 


具有 拓扑 空间 复工 作 空间 的 工业 机 器 人 并 不 常 
见 。 图 10. 3 所 示 是 一 个 满足 区 域 结 构 的 六 轴 解 耦 机 


9) 


图 10.2 Puma 机 器 人 的 工作 空间 
( 引 自 参考 文献 [10.11] ) 


器 人 ， 它 的 相 邻 轴线 相互 垂直 ， 之 间 的 距离 都 是 ao 
两 轴 的 公法 线 与 两 轴 的 交点 之 间 的 距离 也 是 a， 如 
X, MX, X, MX, UR CAZ 之 间 的 距离 也 是 一 
样 。 点 C 是 球形 腕 的 中 心 ， 腕 结构 没有 在 图 中 显 
示 。 机 器 人 的 工作 空间 可 以 用 F(x，y，z) =0 形式 
的 函数 表示 ， 对 应 图 10.4 所 示 的 拓扑 空间 复 。 
图 中 工作 空间 内 部 的 深 色 区 域 对 应 在 该 处 逆 运 动 学 
存在 四 个 实数 解 的 所 有 点 的 集合 ， 其 他 点 处 只 存在 
两 个 解 。 


e 
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Vw 
图 10.3 一 台 包 括 三 个 正 交 的 转动 关节 的 机 器 人 
( 引 自 参考 文献 [10.11] ) 


工作 空间 边界 上 的 任意 点 意味 着 位 置 奇 异 ， 与 姿 
态 奇 异 不 同 ， 工 作 空 间 不 是 拓扑 空间 簇 的 机 器 人 在 工 
作 空间 边界 上 的 楼 线 处 表现 出 两 种 奇异 ， 除 位 置 奇异 
外 还 包括 姿态 奇异 。 在 棱 线 处 雅 可 比 和 矩阵 的 秩 减 少 
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区 域 ” 解 的 数量 
IN ew A 
EN noe 


Y, 


E] 10.4 图 10.3 中 的 正 交 机 器 人 的 工作 空间 
( 引 自 参考 文献 [10.11] ) 


2， 在 边界 上 的 其 他 点 处 秩 减 少 1。 

现在 可 以 概括 出 基于 工作 空间 形状 的 设计 准则 : 

1) 如 果 要 求 工作 空间 是 轴 对 称 的 ， 且 容积 
限 ， 选 用 具有 区 域 结构 的 串联 构 型 ， 且 只 选用 转动 
关节 。 

2) 如 果 要 求 工 作 空间 是 棱柱 形 且 容积 无 限 ， 选 
用 具有 区 域 结 构 的 串联 构 型 ， 第 一 个 关节 选用 棱柱 关 
节 。 在 此 ， 无 限 的 真正 意义 是 沿 某 一 方向 远 远 大 于 其 
他 方向 。 另 外 ， 如 果 要 求 只 沿 一 个 方向 远 远大 于 其 他 
方向 ， 可 棱柱 关节 即 可 以 选用 地 面 上 的 轨道 ， 也 可 以 
选用 空中 的 悬 架 。 如 果 要 求 沿 两 个 方向 远 远大 于 其 他 
方向 ， 则 选用 轮 式 移动 机 器 人 携带 机 械 手 ， 最 著名 的 
例子 是 美国 航空 航天 局 在 1997 年 寻找 到 火星 路 线 计 
划 中 采用 的 Sojourner, 

3) 如 果 不 要 求 工 作 空间 具有 轴 对 称 结构 ， 但 要 
求 若干 共 面 的 对 称 轴 ， 类 似 于 正 多 边 形 结构 ， 选 用 并 
BLA. 


10.2.1 到 达 一 系列 目标 坐标 系 


与 工作 空间 要 求 密切 相关 的 一 个 问题 是 任务 要 
求 。 在 机 械 设计 中 的 一 个 常用 做 法 是 在 空间 中 指定 一 
系列 坐标 系 ， 然 是 设计 一 个 能 够 到 达 所 有 这 些 坐 标 系 
的 符合 预 设 拓扑 结构 的 机 构 。 到 达 各 坐标 系 的 次 序 必 
须 被 指定 。 如 果 不 是 所 有 的 坐标 系 都 能 被 到 达 ， 那 么 
寻求 一 个 能 够 在 某 种 意义 上 最 接近 这 些 坐 标 系 的 机 
构 。 关 于 这 个 经 典 机 构 设 计 问 题 的 文献 有 许多 ， 可 以 
参考 文献 [10.1, 12, 13] 及 其 引用 的 参考 文献 。 
在 此 指出 应 用 这 种 目标 坐标 系 方法 设计 机 器 人 时 需 注 
意 的 几 点 : 

1) 并 不 总 需要 精确 地 达到 期 望 的 坐标 系 ， 有 时 
候 甚 至 是 不 可 能 的 : 某 些 情况 下 更 好 的 选择 是 采用 某 
种 优化 方法 获得 到 达 期 望 位 姿 的 最 小 误差 (保证 误 
差 的 模 满 足 工 程 要 求 ) 。 


2) 参考 文献 [10.9] 中 指出 ， 通 过 区 间 分 析 ， 
考虑 到 制造 误差 因素 ， 不 仅 是 一 系列 离散 的 姿态 ， 而 
是 整个 六 维 工 作 空间 都 可 以 到 达 。 

3) 单 自 由 度 结构 设计 中 的 分 支 问题 在 机 器 人 设 
计 中 也 有 可 能 出 现 : 基于 通过 点 的 设计 结果 可 以 到 达 
所 有 的 期 望 位 姿 , 但 有 可 能 不 能 在 一 个 特定 的 运动 模 
式 中 实现 所 有 的 位 姿 。 这 个 问题 在 机 器 人 设计 中 变 得 
更 为 明显 ， 给 定 一 个 未 段 操 作 手 的 姿态 ， 转 动 解 耦 的 
六 自由 度 串联 机 器 人 可 以 产生 最 多 16 个 可 能 解 ， 即 
S mem 

4) 为 机 器 人 提出 设计 任务 ， 即 要 求 其 末端 操作 
手 能 够 到 达 一 系列 位 姿 时 ， 不 应 忘记 使 用 机 器 人 的 目 
的 不 是 完成 一 个 特定 的 任务 ， 而 是 一 系列 任务 。 选 择 
的 目标 姿态 应 该 能 够 反映 这 些 任 务 。 

结合 上 述 各 点 ， 我 们 可 以 介绍 SCARA 系统 的 设 
计 或 评价 过 程 。SCARA 系统 是 一 个 四 自由 度 的 串联 
机 器 人 ， 可 以 在 通用 刚体 位 移 集合 的 Schónflies 子 集 
内 完成 若干 任务 “1， 也 就 是 除 三 维 的 平移 运动 
外 增加 一 个 绕 固定 轴 的 转动 。 在 这 类 系统 中 ， 手 部 的 
任务 是 一 段 长 300mm 的 水 平 线 段 联 结 的 两 段 长 25mm 
的 垂直 线段 。 末 端 操 作 手 可 以 垂直 运动 ， 同 时 绕 垂直 
轴 在 180^ 范围 内 转动 。SCARA 制造 商 采用 的 任务 规 
范 中 没有 说 明 如 何 处 理 角落 的 问题 ， 这 个 问题 留 给 机 
器 人 工程 师 自由 发 挥 。 


10.2.2 工作 空间 容积 和 拓扑 结构 


1. 可 达 和 灵活 工作 空间 

FH Roth 的 早期 工作 "1 开始， 关于 机 械 手 运动 
学 几何 特性 和 其 工作 空间 之 间 的 关系 已 经 进行 了 许多 
研究 。 大 部 分 研究 中 都 将 工作 空间 分 为 两 部 分 ， 可 达 
空间 和 灵活 空间 ' "1。 为 末端 操作 手指 定 一 个 参考 
点 P， 例 如 球形 腕 的 中 心 或 未 端 操 作 手 上 的 其 他 点 ， 
可 达 空 间 被 定义 为 P 点 在 物理 上 可 到 达 的 空间 点 的 集 
合 。 灵 活 空间 被 定义 为 P 点 可 以 以 任意 末端 操作 手 姿 
态 到 达 的 点 的 集合 。 

关于 工作 空间 的 早期 文献 主要 集中 于 用 数值 或 代 
数 方法 描述 工作 空间 。 可 达 空 间 和 灵活 空间 被 分 别 被 
Kumar 和 Walron! 9?! , Yang 和 Lee!!! 以 及 Tsai 和 
Soni ^ Fl FH BUTT 3 3E 4T T ori. BAR BOTA 
比 ， 这 种 方法 的 主要 优点 是 可 以 方便 地 引入 运动 约 
束 。 但 应 用 这 种 方法 却 难以 获得 通用 的 设计 准则 。 在 
表征 工作 空间 的 代数 方法 中 ，Gupta 和 Roth 9 ?! 以 及 
Gupta ^ ”| 中 采用 了 拓扑 分 析 方 法 ， 并 提出 了 工作 空 
间 中 的 孔 和 空洞 的 概念 ， 并 验证 了 其 存在 条 件 。 可 达 
空间 和 灵活 空间 的 形状 也 被 表述 为 P 的 函数 。 
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Freudenstein 和 Promrose 9 “! ， Lin 9?) 进行 了 更 
深入 的 研究 ， 建 立 了 运动 学 参数 和 工作 空间 之 间 的 精 


需要 指出 ， 得 到 的 实际 数值 受 对 物理 空间 采用 的 长 
度 比例 的 影响 ; 这 点 对 工作 空间 容积 本 身 不 是 个 严 


确 关 系 ， 并 对 一 类 三 关节 机 械 手 针对 工作 空间 的 容积 
进行 了 优化 。Vijaykumar 等 人 对 工作 空间 优化 进行 了 
更 通用 的 分 析 。 根 据 灵 活 空间 定义 了 机 械 手 的 性 能 指 
标 ， 即 给 出 一 个 机 械 手 满足 若干 关于 其 Denavit- 
Hartenberg 参数 的 约束 条 件 ， 结 果 显 示 最 优 的 GR 设 
计 是 肘 式 机 械 手 形式 。 

机 器 人 区 域 结构 的 一 种 典型 设计 是 正 交 形 式 ， 包 
括 一 个 沿 垂 直 轴 转动 的 关节 和 两 个 沿 水 平 轴 转 动 的 关 
节 ， 其 中 一 条 水 平 轴 与 垂直 轴 相 交 。 常 用 的 结构 还 包 
括 长 度 相等 的 中 间 和 远 端 杆 件 。 这 种 结构 的 工作 空间 
是 一 个 半径 为 两 倍 上 述 长 度 的 球体 。 其 容积 自然 由 该 
长 度 决定 。 如 参考 文献 Yoshikawa [10.26] 中 指出 
的 ， 由 上 述 区 域 结构 的 最 后 两 个 杆 件 构 成 的 平面 两 连 
杆 机 械 手 的 工作 空间 是 所 有 具有 同样 杆 件 长 度 的 结构 
中 最 大 的 。 具 有 同样 区 域 机 构 的 机 械 手 的 工作 空间 也 
几乎 是 在 同类 机 器 人 中 最 大 的 。 

2. 微分 几何 工作 空间 表征 


= 


重 的 问题 ， 比 较 不 同 工 作 空间 时 如 果 采 用 相同 的 长 
度 比 例 也 不 是 问题 。 

在 参考 文献 [10.28] F, Paden 和 Sastry 采用 
上 述 几 何 架 构 证 明 满 足 运动 学 长 度 约 束 ， 拥 有 最 大 
工作 空间 的 OR 机 械 手 是 肘 式 机 械 手 ， 这 与 Vijayku- 
mar 等 人 的 早期 成 果 呈 六 一 致 。 此 外 ， 获 得 结果 过 
程 中 ， 没 有 采用 Vijaykumar 所 做 的 关于 运动 学 结构 
的 假设 。 


10.3 灵巧 性 指标 


10.3.1 开 链 结构 的 局 部 灵巧 性 


灵巧 性 可 以 被 定义 为 沿 任意 方向 同样 容易 地 运动 
并 施加 力 和 力矩 的 能 力 ， 这 个 概念 属于 动态 静 力 学 的 
范畴 ， 即 研究 多 肢体 机 械 系统 中 静态 保守 条 件 下 ， 可 
行 复合 速度 和 约束 复合 力 之 间 的 相互 作用 关系 。 这 


如 果 将 机 絮 人 末端 操作 手 的 配置 空间 视 为 一 个 
特定 的 欧 几 里 德 集合 SE (3) WIESE, 工作 空间 也 
可 以 通过 微分 几何 方法 求解 。 在 定义 空间 机 构 的 工 


里 ， 复 合 速度 是 一 个 六 维 的 刚体 速度 矢量 ， 包 括 参 考 
点 的 3 个 速度 分 量 和 刚体 整体 的 3 个 角速度 分 量 。 复 
合力 是 作用 在 刚体 上 的 一 个 六 维 静 态 矢 量 ， 包括 作 用 


作 空 间 容 积 时 需要 考虑 的 一 个 重要 原则 是 其 应 不 受 
选择 的 参考 坐标 系 的 影响 。 这 个 要 求 的 一 个 不 很 直 
观 的 表述 形式 是 : 容积 不 应 受 末 端 操作 手 坐 标 系 被 
定义 在 最 后 一 个 杆 件 上 的 哪 一 点 的 影响 。 这 个 条 件 
有 下 述 物理 意义 : 无 论 操作 手 变 大 或 变 小 ， 机 器 人 
都 应 拥有 同样 的 工作 空间 容积 ， 其 只 取决 于 关节 轴 
线 位 置 。 

如 将 SE (3) 视 为 一 个 Riemanian 拓扑 空间 簇 ， 
则 工作 空间 的 容积 就 是 SE (3) 的 容积 经 运动 学 映射 
f 得 到 的 像 的 容积 。SE (3) 有 一 个 双重 不 变 特性 ， 
即 其 容积 既 不 受 静 坐标 系 ( 机 座 坐 标 系 ) ， 又 不 受 动 
坐标 系 (末端 操作 手 坐 标 系 ) 的 选择 的 影响 ， 见 参 
考 文 献 Loncaric [10. 27 ] Peden 和 Sastry 在 参考 文 
献 [10.28] 中 给 出 了 一 个 直观 的 例子 。 假 设 一 架 飞 
机 被 限制 在 一 个 边 长 1km 的 空间 立方 体内 飞行 ， 在 
这 个 范围 的 任意 一 点 ， 飞 机 可 以 将 其 自身 指向 4" 的 
固态 角 范 围 内 的 任意 一 个 方向 ， 并 可 绕 其 指向 的 方向 
TE 2o 角度 范围 内 横 深 ， 在 每 一 点 处 飞机 的 姿态 容积 
是 47x27=8m rad ， 乘 以 位 置 容积 得 到 飞机 在 自由 
配置 空间 内 的 容积 是 8mrad + km, 

工作 空间 的 这 种 描述 方式 在 机 器 人 学 中 得 到 广 
泛 应 用 ， 主 要 优点 是 不 同 于 灵活 空间 的 常规 定义 ， 
这 种 方式 可 以 协调 处 理 位 置 自 由 度 和 姿态 自由 度 。 


在 参考 点 的 合力 的 3 个 分 量 和 作用 在 物体 上 的 伴随 力 
EES 3 个 分 量 。 

Salisbury 和 Craig! ”| 介绍 了 关节 手臂 设计 过 
程 中 的 灵巧 性 概念 ， 将 其 视 为 由 输入 关节 速度 误 
差 到 指 尖 处 的 输出 速度 之 间 的 传递 关系 。 为 说 明 
这 一 概念 ， 用 J(0) 代表 正和 运动 学 映射 的 雅 可 比 拢 
阵 ， 即 


t=J(0)0 (10.1) 
RP, 030 0. 分 别 代表 关 节 变 量 和 关节 速度 矢量 ， 
t 是 末端 操作 手 的 复合 速度 ， 被 定义 为 


t= " 
sth, o 代表 末端 操作 手 的 角速度 ，p 是 未 端 操作 手 
的 操作 点 尸 的 速度 ， 即 定义 任务 时 的 参考 点 。 


以 n 和 m 分 别 代 表 关 节 空 间 8 和 末端 操作 手 配置 


空间 9 的 维 数 ， 总 有 n 宇 m。 单 位 球面 10 | 16 1 =11 
经 过 映射 J( 9) 的 像 是 复合 速度 空间 上 内 的 一 个 椭 球 
mo 事实 上 ， 即 使 我 们 假定 n =m 得 出 的 结论 ， 也 能 
适应 更 通用 的 情况 n 承 m。 我 们 在 此 保留 完整 的 假设 
是 为 了 以 后 讨论 的 简化 。 对 J ETHIC I fm 
f]. 


(10.2) 


J - RU - VR (10.3) 
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式 中 , R@— TIES, POW eA BI, tery 
以 是 无 理 的 。 有 理 情 况 下 ，R 代表 旋转 ,无理 情况 
F, RRA. UAV 是 对 称 ， 至 少 为 半 正 定 阵 。 
如 果 J 为 非 奇 异 ， 则 UV A VEE, A ERD 
解 方式 唯一 。 这 两 个 矩阵 总 可 以 通过 相似 变换 联系 
在 一 起 


V - RUR' (10.4) 
也 就 是 说 这 两 个 矩阵 具有 相同 的 非 负 实 特征 值 。 这 些 
特征 值 同 时 也 是 .的 奇异 值 。 如 果 用 于 代表 的 对 
角 表 述 形式 ， 其 中 第 i 个 对 角 元 素 是 U 的 第 i 个 特征 
(E, W U 的 特征 值 分 解 是 

U - EXE" (10. 5) 
XB, E EAEE, HON iJ eK Umi 
个 特征 向 量 , 的 第 个 特征 向 量 用 Re, 表示 。 如 果 
将 也 的 特征 值 分解 带 入 到 yy 的 极 值 分解 式 (10.3) 
中 ， 得 到 


Nm 


J = REXE* (10. 6) 
也 就 是 J 的 奇异 值 分 解 ，3 的 各 对 角 线 元 素 也 就 是 J 
的 奇异 值 。 
现在 可 以 给 出 正 运 动 学 映射 ， 式 (10.1) 的 几 
何 解 释 ， 为 此 将 其 改写 为 
t = RUO (10.7) 
对 于 一 个 非 奇 异 姿态 ， 雅 可 比 矩 阵 式 可 逆 ， 同 理 U 
也 可 逆 ， 由 上 式 可 得 到 
0 -U^ Rt (10. 8) 
进一步 ， 如 果 假 定 复合 速度 向 量 上 和 关节 速度 向 
HO 的 所 有 元 素 都 有 同样 的 物理 单位 ， 即 纯 平 动 或 
纯 转 动机 右 人 的 情况 ， 则 可 以 对 (10.8) 取 两 端 取 
欧 几 里 德 模 数 ， 得 到 


6 |? =e"RUR't (10.9) 
将 忌 用 它 的 特征 值 分 解 ， 式 (10.5) 代替 ， 
得 到 
l8 |? -ZREX^E'R't 
如 果 定 义 
v -ER!t (10. 10) 
则 上 式 变 为 
y'X-y- |o |P (10. 11) 


WR v 的 第 i 个 元 素 记 作 vw,，i=1，…，n， 对 于 
8g 内 的 单位 球 | 上 0 |P =1， 式 (10.11) 变 为 


A v, NE^ 


21 (10. 12) 


v, 
BIG zs qe], Bk AB JL 3E BE 2x [8] rp 2E 2 a Z6 


1o,1 ?的 椭 球 的 标准 方程 。 需 要 指出 ， 该 椭 球 只 有 在 
特定 的 坐标 系 内 才能 表述 为 标准 形式 ， 即 坐标 轴 的 方 
向 与 U 的 特征 向 量 的 方向 一 致 。 椭 球 在 9 空间 内 的 通 


用 表达 式 是 


LRES -ER't=1 (10. 13) 

总 之 ， 关 节 空 间 的 一 个 单位 球 被 逆 雅 可 比 和 矩阵 

7 映射 为 一 个 椭 球 ， 其 半 轴 长 度 是 了 的 奇异 值 。 即 
J 将 关节 速度 空间 的 单位 球 扭曲 为 末端 操作 手 复合 速 
度 空间 的 一 个 椭 球 。 这 种 扭曲 可 以 作为 由 机 器 人 结构 
决定 的 运动 和 力 传递 质量 的 一 个 度量 ; 扭曲 越 小 ， 传 
递 的 质量 越 高 。 
由 雅 可 比 和 矩阵 导致 的 扭曲 的 度量 还 可 以 被 定义 为 
的 最 大 奇异 值 cv 和 最 小 奇异 值 c,, 之 间 的 比例 ， 也 
被 称 为 了 的 条 件数 ie, ， 利 用 抢 阵 的 2 范 数 1 得 到 


Ou 
K, = 一 


(10. 14) 


o m 

RE, st (10.14) 只 是 计算 了 或 任意 mxn 
SAE RE EI] A AP AY RT 88 77 TT AS Je RC eT 
的 。 这 种 定义 中 要 求 已 知 雅 可 比 矩 阵 的 奇异 值 。 但 
是 ， 奇 异 值 和 特征 值 的 计算 量 都 很 大 ， 再 加 上 极 值 分 
解 的 计算 量 ， 这 样 做 的 计算 量 只 是 略 小 于 奇异 值 分 解 
的 计算 量 '* 引 。 对 于 一 个 nxn 维 的 敌阵 ， 条 件数 的 
更 通用 的 定义 是 "|. 
K(A) = IA llla Il (10. 15) 
如 上 所 述 ， 式 (10.14) 是 在 (10.15) 式 中 采用 所 
阵 2 TRARY. FARE 2 范 数 定义 为 


|A ll m maxi | 


(10. 16) 
男 一 方面 ， 可 以 采用 和 矩阵 的 加 权 Frobenius 76 2X, XE 
义 如 下 

Alo | Lecta) = [I ata) (10. 17) 
显然 ， 奇 异 值 的 计算 被 避免 了 。 如 果 在 上 述 定 义 中 省 
略 权 值 一 ， 就 得 到 标准 的 Frobenius 范 数 。 在 工程 中 
加 权 Frobenius 范 数 应 用 更 为 广泛 ， 因 为 它 不 取决 于 
FE MEAT AN Št. DNA Frobenius 范 数 实际 上 得 到 奇 
异 值 的 均 方 根 值 (rms) 。 

FEF $64 AY) Frobenius 范 数 ， 可 以 得 到 雅 可 比 矩 
RE J HJ Frobenius 条 件数 Ky 


ie) =+ VQ) Vi PY 
= VTD Se PDT 0018) 


上 述 两 种 计算 和 矩阵 的 条 件数 的 方法 之 间 还 有 一 点 
EEJ: (e) 是 它 的 自 变量 矩阵 的 解析 函数 ， 


lili 
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K.) 则 不 是 。 因 此 基于 Frobenius 范 数 得 到 的 条 件 
数 在 机 器 人 结构 设计 中 拥有 巨大 的 优势 。k;(. ) 是 


T 


邻 关节 轴线 间 的 角度 ， 可 以 得 到 机 器 人 的 最 大 可 达 范 


可 微 的 ， 可 用 于 基于 梯度 的 优化 方法 ， 运 行 远 远 快 于 
仪 依靠 函数 评价 的 直接 方法 。 在 要 求实 时 计算 的 机 器 
人 控制 中 ，kr(，) 也 体现 出 优势 ， 因 为 在 计算 过 程 
中 不 需要 计算 奇异 值 ， 只 需要 进行 矩阵 求 逆 ， 所 以 速 
度 更 快 。 

我 们 注意 到 条 件数 的 概念 来 源 于 由 线性 系统 方程 


(10. 1) 求解 9 的 过 程 ， 这 有 助 于 更 好 地 理解 条 件数 
在 机 器 人 设计 和 控制 中 的 重要 性 。J 是 结构 参数 和 姿 
态 变量 9 的 函数 ， 其 中 必然 包含 已 知 等 级 的 误差 。 结 
构 参 数 ， 也 就 是 Denavit- Hartenberg 表 中 的 常数 ， 被 
存储 在 向 量 中 , p 和 0 中 必然 包括 各 自 的 误差 5p 
和 59。 此 外 ， 机 器 人 控制 软件 的 输入 ， 复 合 速度 上 也 
不 可 避免 地 含有 误差 51。 

采用 浮 点 数 求解 式 (10.1) 得 到 0 的 过 程 中 ， 


得 到 的 结果 必然 包含 截 尾 误差 69。0 中 的 相对 误差 
受 结 构 参数 和 姿态 变量 的 相对 误差 影响 ”1 
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"T ipi llell lei 
SUP, p 和 0 代表 各 自 (ARIAT) 实际 值 ; t 代表 复 
合 速度 的 名 义 值 。 
然而 ， 上 述 讨论 中 的 任务 包括 位 置 或 姿态 要 求 ， 
但 不 同时 包括 两 者 。 现 实 中 ， 大 多 机 器 人 任务 既 包 括 
位 置 ， 又 包括 姿态 要 求 ， 这 样 雅 可 比 矩 阵 的 不 同 元 素 
具有 不 同 的 单位 ， 从 而 其 奇异 值 也 具有 不 同 的 单位 。 
和 位 置 相 关 的 奇异 值 具有 长 度 单 位 ， 和 姿态 相关 的 是 
无 量 纲 的 。 这 样 ， 就 不 可 能 对 所 有 奇异 值 排序 或 
求 和 。 
为 处 理 这 一 问题 ， 并 计算 雅 可 比 和 矩阵 的 条 件数 ， 
村 征 长 度 的 概念 被 提出 局 2 。 特 征 长 度 工 被 定义 为 
在 某 个 最 优 姿态 下 ， 雅 可 比 矩 阵 的 带 有 长 度 单位 的 元 
素 被 分 离 出 来 使 得 雅 可 比 和 矩阵 的 条 件数 达到 最 小 值 的 
长 度 。 因 为 定义 的 方式 非常 抽象 ， 缺 乏 清晰 的 几何 意 
义 ， 使 其 在 机 器 人 领域 的 应 用 非常 困难 。 为 提供 明确 
的 几何 意义 ,最 近 齐 次 空间 的 概念 被 提出 '"”I。 利 
用 这 一 概念 ， 机 器 人 结构 在 一 无 量 纲 空间 中 设计 ， 所 
有 点 的 坐标 都 是 无 量 纲 实数 。 这 样 做 ,一 条 直线 的 六 
个 Plücker 坐标 "也 都 是 无 量 纲 的 。 机 器 人 的 雅 可 
比 和 矩阵 的 每 一 列 对 应 转动 轴线 的 Plicker 坐标 ， 也 是 
无 量 纲 的 。 雅 可 比 矩 阵 的 奇异 值 也 是 无 量 纲 的 ， 则 其 
条 件数 可 以 被 定义 。 对 应 最 小 条 件数 ， 确 定 机 器 人 的 
结构 时 ， 若 满足 若干 几何 约束 ， 如 杆 件 长 度 比 例 和 相 


(10. 19) 


— 


定 的 拥有 长 度 单位 的 最 大 可 达 范 围 R 相 比较 ,特征 
长 度 就 是 比例 元 = R/r。 


基于 动力 学 的 局 部 性 能 评价 


既然 运动 是 由 力 或 力矩 作用 在 刚体 上 造成 的 ， 一 
个 自然 的 想法 是 定义 考虑 机 构 的 惯性 特性 的 性 能 指 
bk. Asada "7" 定义 了 广义 惯量 椭 球 (GIE)， 即 对 应 
G=J MJ 的 椭 球 ， 其 中 M 是 机 械 手 的 惯量 和 矩阵。 
这 个 椭 球 的 半 轴 是 上 文 介绍 的 奇异 值 。Yoshikawal 3261 
定义 了 相应 的 动态 操作 性 度量 为 del JM (JM)! ]。 
从 物理 角度 看 ， 这 些 概 念 对 应 两 种 现象 。 若 将 机 器 人 
视 为 一 个 输入 -输出 设备 ， 即 给 定 关节 力矩 ， 产 生来 
端 操 作 手 处 的 加 速度 。Yoshikawa 的 指标 反映 这 种 力 
矩 -加 速度 增益 的 一 致 性 ，Asada 的 广义 惯量 椭 球 表 
征 这 个 增益 的 逆 。 如 果 一 个 操作 者 握 住 机 器 人 的 末端 
操作 手 尝 试 移动 机 器 人 ， 广 义 惯量 椭 球 将 反映 机 器 人 
对 这 种 末端 操作 手 运 动 的 阻抗 。 

其 他 将 机 器 人 的 性 能 视 为 动力 学 的 函数 的 度量 包 
括 : Voglewede 和 Ebert- Uphoff! 37 提出 的 基于 关节 
刚度 和 杆 件 惯量 的 性 能 指标 ， 其 目的 是 确定 由 机 器 人 
的 任意 姿态 到 奇异 状态 之 间 的 距离 。Bowling 和 Khat- 
ib'3 提 出 了 广义 坐标 系 来 评价 一 个 广义 机 械 手 的 动 
态 能 力 ， 其 中 包括 了 末端 操作 手 的 速度 和 加 速度 ， 还 
考虑 了 力矩 和 执行 器 所 受 的 速度 限制 。 


10. 3.3 全 局 灵巧 性 度量 


上 述 度量 值 都 只 具有 局 部 意义 因为 它们 都 只 针对 
给 定 的 姿态 。 局 部 度量 对 很 多 应 用 具有 意义 ， 如 元 余 
求解 和 工件 定位 。 为 了 设计 目的 ， 更 需要 一 种 全 局 的 
度量 。 将 局 部 度量 推广 到 全 局 的 一 个 直观 方法 是 将 局 
部 度量 在 整个 可 行 的 关节 空间 积分 。 在 参考 文献 
[10.39] "P, Gosselin 和 Angeles 将 雅 可 比 条 件数 在 
整个 工作 空间 上 积分 来 定义 一 种 全 局 度量 ， 被 称 为 全 
局 条 件 指标 。 对 于 简单 的 情况 ， 如 平面 定位 和 球形 机 
械 手 ， 全 局 条 件 指标 和 对 应 的 局 部 度量 完全 吻合 。 


闭 链 灵 巧 性 指标 


建立 财 链 的 灵巧 性 具有 若干 不 同 点 。 第 一 个 明显 
的 差别 是 闭 链 的 关节 配置 空间 不 再 是 平坦 的 ， 一 般 情 
况 下 是 高 维 空间 内 的 曲面 。 此 外 ， 与 开 链 情况 不 同 ， 
闭 链 的 正 运动 学 问题 比 逆 运 动 学 问题 更 困难 ， 有 可 能 
存在 多 个 解 。 男 一 个 重要 区 别 是 尽管 只 有 部 分 关节 是 
可 以 主动 驱动 的 ， 这 个 数目 仍然 可 能 超过 机 融 人 的 自 


4 
围 。 这 个 最 大 可 达 范 围 r 是 一 个 无 量 纲 数 ， 将 其 与 规 
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10. 3.4 
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由 度数 目 。 

一 些 针 对 特定 机 构 '"” 和 所 有 关节 都 可 被 驱动 
的 协作 机 器 人 系统 ”的 基于 坐标 的 闭 链 灵 巧 性 
度量 已 经 被 提出 ， 部 分 方法 得 到 的 结果 相互 巴 
Jg 5^5. pip. ESCAT ZR BRL PL LS A A BY) 3E £X TE 
特性 ， 为 它们 建立 基于 坐标 的 灵巧 性 度量 时 需要 特别 
关注 。 

男 一 个 新 近 的 研究 方向 是 为 闭 链 结构 的 灵巧 性 
建立 不 随 坐 标 系 变 化 的 微分 几何 表达 式 。 在 这 个 框 
架 下 关节 和 末端 操作 手 配置 空间 被 视 为 通过 适当 选 
择 的 Riemannian 度量 的 Riemannian 拓扑 空间 艇 ， 其 
中 关节 空间 度量 的 选择 反映 关节 执行 器 的 特性 。 为 
串联 结构 开发 的 椭 球 概念 也 可 以 被 推广 到 通用 的 闭 
链 情 况 ， 可 以 包括 主动 和 被 动 关节 ， 包 括 见 余 驱 动 


情况 [10. 45,46] R 
10.3.5 修正 的 类 灵巧 性 度量 


上 述 对 灵巧 性 的 不 同 定 义 都 定性 地 反映 机 顺 
人 沿 任意 方向 运动 和 施加 力 的 能 力 。Liegeois ^ 4 
和 Klein, Huang ^ f TE, RH T As In] AY BE 
角 ， 其 中 灵巧 性 通过 关节 范围 的 可 实行 性 来 定量 
地 描述 。 这 样 做 的 动机 是 因为 大 部 分 机 器 人 关节 
都 存在 限制 ， 因 此 应 将 关节 到 达 停 止 位 置 的 可 能 
性 降 到 最 低 。 

Hollerbach 号 采用 了 一 种 修正 的 方法 来 设计 一 
个 宛 余 的 7R 机 械 手 ， 考 虑 的 因素 包括 : 中 避免 内 部 
奇异 点 ; @ 工 作 空间 中 的 避 障 能 力 ;@@ 和 运动 学 方程 的 
可 解 性 ; 由 机 械 的 可 构建 性 。 基 于 这 四 条 准则 ， 他 得 
到 了 一 种 特定 的 7R 设计 ， 和 人 类 手臂 具有 相同 的 形 
态 构 型 ， 两 个 球 关 节 相 当 于 肩 关 节 和 腕 关节 ， 以 及 一 
个 转 劲 关节 相当 于 肘 关 节 。 通 常情 况 下 ， 锁 定 宛 余 机 
器 人 的 一 个 关节 ， 机 器 人 仍然 可 以 完成 普通 的 六 自由 
度 任 务 ， 对 于 该 结构 ， 如 果 锁 定 肘 关节 ， 该 机 器 人 将 
失去 这 种 操作 能 

从 控制 角度 出 发 ，Spong 邮 2 指出， 如 果 机 械 手 
的 惯量 矩阵 具有 消失 的 Riemannian 弯曲 ， 则 存在 一 
系列 坐标 系 ， 在 其 中 运动 方式 可 以 具有 特别 的 简化 形 
式 。 惯 量 和 矩阵 的 弯曲 也 反映 了 动力 学 特性 对 某 些 机 顺 
人 参数 的 敏感 度 。 最 小 化 这 种 弯曲 ， 是 另 一 种 可 能 的 
机 器 人 设计 标准 。 


其 他 性 能 指标 


10. 4 


10.4.1 加 速度 半径 
另 一 种 表征 机 械 手动 态 能 力 的 度量 是 加 速度 半 


径 ， 最 初 由 Graettinger 和 Krogh 在 参考 文献 [10.51] 
中 提出 ， 其 意义 是 给 定 执行 器 所 受 的 力矩 限制 ， 反映 
末端 操作 手 在 任意 方向 上 的 最 小 加 速度 能 力 。 特 别 
地 ， 给 定 一 个 串联 链 的 动力 学 方程 

T-M(0)0 «C(0,0 )0 (10. 20) 
式 中 ，M 是 机 器 人 的 质量 矩阵 ， 也 被 称 为 关节 空间 
中 的 惯量 矩阵 ，C(9，0 ) 是 由 关节 速度 向 量 到 科 氏 
力 和 离心 力 矢量 的 映射 矩阵 。 执 行 器 受到 力矩 限制 ， 
形 如 


Tin SES Tmax (10. 21) 
WEAF BRAN EPR ZJARTas, Tas e RR" 是 常数 或 机 械 手 


姿态 9 的 函数 。 末 端 操 作 手 复合 速度 的 变化 率 1 为 
i =J(0)0 +J (0,0)0 


P, J(0, 0) 是 雅 可 比 矩 阵 的 时 间 导 数 。 假 设 
JCO) 是 非 奇异 的 ， 可 以 得 到 


(10. 22) 


0 -J(0)^ i -J(0)"J (0,t) (10.23) 
将 上 式 代 入 动力 学 方程 (10.20), ， 得 到 
T(0,t,t ) -M'(0)  «C'(0,t) (10.24) 


其 中 
M'(0) -M(0)J(0) ^ 


C'(0,t) -[C(0,)) -M(0)J(0) ^J (0,0 J^ (0) 


对 于 给 定 的 状态 (9，9 ) ， 线 性 力矩 限制 (10.21) 
定义 了 一 个 复合 加 速度 空间 内 的 多 面体 。Greaetinger 
和 Krogh?" 将 加 速度 半径 定义 为 中 心 在 原点 ， 完 全 
包含 在 这 个 多 面体 内 的 球 的 最 大 半径 。 其 代表 末端 操 
作 手 在 任意 方向 的 最 小 加 速度 。 这 个 概念 被 用 来 衡量 
机 械 手 的 加 速度 能 力 ， 也 被 用 来 确定 执行 涡 的 尺寸 来 
获得 期 望 的 加 速度 半径 。Bowling 和 Khatib "将 这 
一 概念 推广 以 衡量 末端 操作 手 的 力 和 加 速度 能 力 ， 定 
量 描述 机 械 手 的 最 差 动态 表现 。 


10.4.2 ” 静 弹 性 性 能 


静 弹 性 性 能 反映 机 器 人 在 项 平衡 条 件 下 对 外 加 
负载 - 力 和 力矩 的 响应 。 这 种 响应 体现 为 机 械 手 的 刚 
度 ， 即 末端 操作 手 受 外 加 复合 力 时 的 位 移 和 和 角度 

机 器 人 形变 有 两 个 来 源 : 杆 件 和 关节 形变 。 对 应 
杆 件 很 长 的 情况 ， 如 空间 机 器 人 -加 拿 大 手臂 2 型 ， 
杆 件 柔 性 是 形变 的 主要 来 源 。 对 于 当今 大 多 数 串 联机 
器 人 ， 形 变 主要 出 现在 关节 处 。 

在 本 章 中 ， 我 们 认为 机 器 人 杆 件 是 刚性 的 ， 关 节 
模型 是 线 弹 性 扭转 弹簧 。 更 复杂 的 杆 件 柔性 问题 将 在 
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第 13 章 中 深入 介绍 。 关 于 静 弹 性 模型 ， 我 们 的 分 析 
建立 在 一 下 假设 基础 上 : 对 于 定位 任务 ， 关 节 锁 定 在 
某 一 姿态 内 处 ， 末 端 操作 手 受 到 复合 力 扰动 Aw 作 
用 ， 其 被 弹性 关节 力矩 AT 所 平衡 。 在 该 条 件 下 ，Ab 
和 Az 之 间 服 从 著名 的 线性 关系 
KAO=AT (10.25) 
式 中 , K 是 关节 空间 中 对 应 给 定 姿态 处 的 刚度 矩阵， 
是 一 个 对 角 阵 ， 各 对 角 线 元 素 分 别 对 应 各 关节 的 扭转 
刚度 ， 因 此 KK 是 姿态 独立 的 ， 即 在 整个 机 器 人 工作 
空间 内 为 常数 矩阵 。 另 外， 因为 所 有 关节 都 具有 有 限 
的 非 零 刚度 ， 因 此 天 是 可 逆 的 ， 其 逆 阵 C 被 称 为 柔 
顺和 矩阵 。 可 以 将 (10.25) 式 的 道 表示 为 

A0 -CAT (10. 26) 
TAA AO 和 AT 都 具有 增 量 的 本 质 ， 都 由 平衡 姿态 处 
开始 测量 ， 在 平衡 姿态 处 ， 二 者 均 为 0。 
关于 刚度 矩阵 ，Griffis 和 Duffy f£ i T — 
种 由 刚体 位 移 增 量 Ax 到 复合 力 增 量 Aw 的 不 具有 
对 称 性 的 上 映射。 映射 背后 的 概念 是 Howard 等 人 在 
参考 文献 [10.53] 中 利用 Lie 代数 方式 提出 的 。 
但 在 上 述 文章 中 ，Ax 和 Aw 是 不 匹配 的 ， 它们 的 
乘积 并 不 代表 功 的 增 量 ， 因 为 Ax 并 不 出 现在 Aw 
的 作用 点 ， 因 此 ， 上 述 映 射 的 矩阵 形式 并 不 代表 
刚度 矩阵 。 

给 定 相同 幅 值 的 Ar， 变形 在 与 C 的 最 大 特征 
值 ， 即 的 最 小 特征 值 (表示 为 km) ， 对 应 的 特征 
向 量 方向 上 的 形变 最 大 。 关 于 静 弹 性 性 能 ， 我 们 的 
目标 是 : 最 小 化 最 大 形变 ， 即 最 大 化 kug Qf 
形变 的 幅 值 A0l| 尽 可 能 关于 负载 Ar 的 作用 方向 不 
敏感。 可 以 通过 使 及,, 尽 可 能 接近 天 ,来 实现 。 第 
一 个 目标 与 刚度 常数 相关 ， 该 常数 越 大 ， 形 变 越 小 。 
第 二 个 目标 涉及 各 向 同性 ， 最 理想 的 情况 是 天 的 所 
有 特征 值 都 相等 ， 即 天 本 身 是 各 向 同性 的 。 由 于 虽 
联机 器 人 的 金字 塔 效应 ， 即 靠近 机 座 的 电动 机 需要 
支撑 其 后 所 有 部 分 ， 整 体 的 刚度 由 靠近 机 座 的 关节 
决定 ， 因 此 ， 串 联机 械 手 不 可 能 具有 各 向 同性 的 刚 
JE A BE 

3X (10.25) 和 式 (10.26) 也 可 以 在 任务 空间 
中 表述 为 


KAx = Aw (10. 27) 
式 中 ，Ax=tAt，At 代表 一 个 时 间 间 隔 微 量 ， 在 此 期 
间 内 末端 操作 手 的 姿态 变化 微量 是 Ax， 即 
Ax =J0 At = JAO (10.28) 
是 一 个 由 关节 增 量 向 量 到 位 姿 增 量 向 量 的 线性 变换 。 
下 面 我 们 将 说 明 刚 度 和 矩阵 不 是 坐标 系 不 变 的 ， 即 在 由 


关节 空间 到 笛 卡 儿 空 间 的 线性 变换 中 ， 刚 度 和 矩阵 不 满 
足 相似 变换 。 我 们 首先 简要 回顾 相似 变换 的 定义 ， 如 
R y = Lx 是 一 个 由 R" 空 间 到 其 自身 的 线性 变换 ， 引 
入 向 量 基 的 变化 ,xz = Ax, y' = Ay, Wl] LÆR, 
即 满足 下 式 


L' = ALA™' (10. 29) 
上 述 变换 将 R" 空 间 内 的 任意 向 量变 换 为 同一 空间 内 
的 男 一 向 量 ， 将 矩阵 工 变换 为 L'"， 如 式 (10.29) 所 
示 ， 称 为 相似 变换 。 因 为 A 代表 坐标 系 之 间 的 转换 ， 
所 以 其 必然 可 逆 。 
现在 ， 由 式 (10.28) 和 式 (10.27) 给 出 的 坐 
标 变换 ， 可 以 得 到 


K JAO =J "^T 
Hope Ts EAA ASR IR UP TS 

J'Aw-AT 
felt, EXE -T ERER, eR. dE 
st (10.30) 两 端 同时 左 乘 J^, ATLAS 2 

J'K JAO =AT (10. 31) 

比较 式 (10.25) 和 式 (10.31) ， 可 以 得 到 关节 

空间 的 刚度 矩阵 玉 和 笛 卡 儿 空间 的 刚度 矩阵 Ke 之 间 
的 关系 


(10. 30) 


K=J KJ 或 K.=J "KJ (10. 32) 

显然 KK 和 KK 之 间 不 满足 相似 变换 。 意 味 着 这 两 

个 矩阵 不 会 具有 完全 相同 的 特征 值 ， 它 们 的 特征 向 量 
也 不 能 通过 式 (10.28) 描述 的 线性 关系 相关 联 。 事 
实 上 ， 如 果 机 器 人 是 转动 耦合 的 ， 它 的 刚度 矩阵 天 
的 元 素 都 具有 单位 N . m， 即 扭转 刚度 ， 而 K. 的 元 素 
具有 不 同 的 单位 。 为 说 明 这 点 ， 将 雅 可 比 和 矩阵 和 其 
道 ， 以 及 两 个 刚度 矩阵 都 分 解 为 四 个 3 x3 的 子 


块 ， 即 
"EE. 
r-l 2 
K, =|. 
Ko, Ke 
由 复合 速度 的 定义 式 (10.2) AT, J 的 上 半 
部 分 的 两 个 子 块 是 无 量 纲 的 ， 它 的 下 半 部 分 的 两 
个 子 块 具有 长 度 单位 加 , DRE, J 左 侧 的 两 个 
子 块 是 无 量 纲 的 ， 其 右 侧 的 两 个 子 块 具 有 首长 度 
单位 。Kc 的 各 子 块 可 由 式 (10.32) 所 示 的 关系 
得 出 : 
Ka, =J'ù (Ki Ji + 
Ka; -J' (Ki Ji + 


Ky Jo) + Ta (KoJa + KJ ) 
KoJa) +S (Kindy + KJ) 
Koo, = Koy 

KoJa) + I'm (Kind in + KJ) 


Kon =D ts s m 
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SEA, Ka 的 元 素 的 单位 是 N * m， 即 扭转 刚度 ， 
Kon 和 Ko 的 元 素 的 单位 是 N， Key, 的 元 素 的 单位 是 
N/m， 即 平移 刚度 。 

上 述 讨 论 的 结论 是 可 以 得 到 K 的 范 数 ， 但 不 能 
直接 得 到 K. 的 范 数 ， 除 了 引 人 特 征 长 度 使 得 Ke 的 所 
有 元 素 成 为 齐 次 无 量 纲 的 。 和 矩阵 的 范 数 是 有 用 的 工 
具 ， 因 为 它 表 征 和 矩阵 的 元 素 有 多 大 。 我 们 希望 确定 机 
器 人 在 关节 空间 和 笛 卡 儿 空间 的 刚度 如 何 ， 在 关节 空 
间 ， 我 们 可 以 采用 任何 范 数 ， 需 要 指出 ， 式 (10.3) 
介绍 的 2 范 数 并 不 适合 ， 因 为 它 会 把 最 强 的 关节 的 刚 
度 赋 予 整个 机 器 人 系统 ， 更 合适 的 方式 是 采用 式 
(10. 17) 描述 的 加 权 Frobenius 范 数 ， 它 采用 各 关节 
刚度 的 均 方 根 值 。 

为 实现 机 器 人 的 最 优 设 计 ， 我 们 将 力求 获得 在 关 
节 空 间 的 刚度 矩阵 的 Frobenius 范 数 的 最 大 值 ， 同 时 
兼顾 机 器 人 重量 的 约束 。 因 为 如 果 所 有 的 关节 都 选用 
同样 的 材料 ， 刚 度 越 大 意味 着 关节 越 重 。 


10.4.3 ”动弹 性 性 能 


对 于 一 个 通用 的 设计 问题 ， 不 仪 动态 静 力 学 和 更 
弹性 性 能 ， 还 需要 考虑 动弹 性 性 能 。 因 此 ， 我 们 在 
10.4.2 节 介 绍 的 假设 的 基础 上 ， 增 加 一 个 条 件 ， 即 
考虑 由 杆 件 质量 和 转动 惯量 导致 的 惯性 力 。 

在 给 定 的 姿态 由， 忽略 阻尼 项 ， 一 个 串联 机 器 
人 的 线性 化 模型 可 写成 

MAO +KA0=AT (10. 33) 
XP, M 是 10.4.1 节 中 介绍 的 nxn 维 正定 质量 阵 ， 
K 是 10.4.2 节 中 介绍 的 关节 空间 中 的 nxn 维 正定 刚 
REER, M 和 都 在 关节 空间 坐标 系 内 定义 ，A09 代 
表 关 节 变 量 弹性 位 移 向 量 。 这 些 位 移 产 生 的 前 提 是 各 
关节 被 锁定 在 位 置 04b, 具有 理想 的 线 弹 性 特性 。 
机 器 人 受到 扰动 AT 的 作用 ， 或 存在 一 个 不 为 零 的 初 
始 条 件 ， 或 二 者 皆 存 在 。 

在 自由 振动 情况 下 ， 即 系统 (10.33) 的 运动 由 
非 零 初始 条 件 导 致 ， 扰 动 A 7 为 去， 则 可 由 上 述 方程 


求解 出 A0 : 


A0 = -DA0,D-M^'K (10. 34) 
AP, 万 被 定义 为 动力 学 矩阵 。 其 决定 被 考虑 的 系统 
的 行为 ， 因 为 它 的 特征 值 就 是 系统 的 固有 频率 ， 而 其 
特征 向 量 对 应 系统 的 模 态 向 量 。 以 foo, RI |] 分 
IRE D 的 特征 值 和 特征 向 量 的 集合 。 在 初始 条 件 
[A6(0), ，Ab (0)] "情况 下 ， 其 中 Ag(0) 与 D 的 第 


个 特征 向 量 成 比例 ， 且 A0 (0) =0， 则 系统 的 运动 形 


~. 


式 为 AI) = AB(0) cosa, t! 1 354 P 

进一步 ， 在 式 (10. 28) 描述 的 变化 情况 下 ， 模 
型 (10.33) 变化 为 

MJ Ax «KJ ! Ax =J' Aw 

fe EXC ES js AB ELA", ELS Sp Be 

(10.33) 在 笛 卡 儿 坐 标 系 下 的 动弹 性 模型 
J -MJ IAX +J KJ 'Ax= Aw 
其 中 第 一 个 矩阵 系数 是 笛 卡 儿 坐 标 系 下 的 质量 矩阵 
M.-9J"MJ^ (10. 35) 

第 二 个 系数 是 式 (10.32) 中 定义 的 K.。 在 笛 卡 儿 坐 
标 系 下 的 动弹 性 模型 可 以 写 为 
MAX +K,Ax = Aw (10. 36) 
再 次 重申 ， 由 变换 (10.35) 可 知 ， 与 刚度 矩阵 类 似 ， 
质量 矩阵 同样 不 具有 在 不 同 坐 标 系 下 的 不 变性 。 对 于 转 
AMPLIAS, M 的 所 有 元 素 的 单位 都 是 kg * m^, 
但 Me 的 元 素 具 有 不 同 的 单位 。 与 10. 4. 2 节 中 对 笛 
儿 空 间 中 的 刚度 矩阵 进行 的 类 似 的 分 析 表 明 ， 如 果 将 
Me 分 解 为 4 个 3 x3 的 子 块 ， 则 它 的 左上 子 块 具有 转 
动 惯量 单位 ， 它 的 右 下 子 块 具有 质量 单位 ， 其 他 非 对 
角 块 的 单位 是 kg. mo 

笛 卡 儿 空间 中 的 动力 学 矩阵 相应 变化 为 

D, - M'K, (10. 37) 

证 明 动 力学 矩阵 具有 相对 坐标 系 的 不 变性 非常 简单 。 
将 变换 (10.32) 和 (10.35) 代入 式 (10.37)， 可 
以 得 到 


D, -JMCDEJCKJI =JM KI 
其 中 可 以 发 现 关 节 坐 标 系 中 的 动力 学 和 矩阵 D 的 表达 
式 ， 因 此 有 


D,.=JDJ™' (10. 38) 
也 就 意味 着 DÆ D 的 相似 变换 。 从 而 ,动力 学 矩阵 
在 坐标 系 改变 时 具有 不 变性 ， 即 两 个 矩阵 具有 相同 的 
特征 值 集合 ， 它 们 的 特征 向 量 之 间 满 足 同样 的 相似 变 
He, WAR D 在 关节 空间 中 的 模 态 向 量 记 为 | 关上， 对 
应 笛 卡 儿 空 间 内 的 模 态 向 量 记 为 {8,1'， 则 这 两 个 集 
合 之 间 的 相互 关系 是 
Bi (10.39) 
因此 ， 无 论 在 哪个 空间 中 计算 ， 动 弹性 模型 的 固 
有 频率 总 是 相同 的 ， 振 动 的 自然 模 态 的 变换 符合 相似 
变换 。 
在 零 初始 条 件 下 ， 受 到 形 如 AT = 0 cosot 的 激励 
作用 时 ， 系 统 的 响应 将 是 频率 为 o 的 简 谐 运 动 ， 其 
幅 值 将 同时 取决 于 w 和 系统 的 频率 谱 | w,}? 
[10.54], 35» 等 于 系统 的 自然 频率 时 ， 响 应 的 幅 值 
将 无 限 地 增 大 ， 即 出 现 共振 现象 。 由 于 这 个 原因 ， 在 


i=1,,n 


194 


第 2 篇 


机 器 人 结构 


设计 机 器 人 时 ， 需 要 严格 地 保证 它 的 频率 谱 不 包含 任 
何 期 望 的 工作 频率 。 这 点 可 以 通过 调整 机 器 人 的 质量 


m 


LZE 


和 刚度 矩阵 来 使 得 机 器 人 的 频率 谱 处 于 所 有 工作 条 件 


的 频率 范 ES 
设计 不 是 一 个 直截了当 的 任务 。 


之 外 来 实现 。 


Mil 


EKE, RW 


空间 中 刚度 矩阵 是 常数 和 矩阵， 而 质量 矩阵 则 取决 于 当 


前 的 姿态 ， 即 M=M(0)。 因 为 这 一 特性 ， 机 絮 人 的 


动弹 性 设计 是 个 兴 代 的 过 程 : 设计 过 程 如 同一 个 稻草 


任务 。 给 定 一 个 典型 的 任务 ， 包 括 一 系列 的 姿态 ， 


对 应 存在 一 系列 的 质量 矩阵 。 随 后， 对 应 所 有 这 些 姿 
态 的 频率 谱 将 被 设计 处 于 稻草 人 任务 的 频率 范围 之 


外 。 鉴 于 机 器 人 终究 将 执行 与 稻草 人 任务 不 同 的 任 


务 ， 需 要 进行 针对 不 同 任务 的 仿真 由 共振 角度 来 确保 


设计 的 安全 性 。 
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运动 学 元 余 机 械 臂 


Stefano Chiaverini, Giuseppe Oriolo, Ian D. Walker 


吴 立 成 译 
本 音 主 要 讨论 元 余 度 求解 的 方法 ， 即 在 求解 道 11.2 面向 任务 的 运动 学 和 PN 198 
运动 学 问题 时 利用 元 余 自 由 度 的 技巧 。 显然 ， 这 是 11.2.1 EK ZEE cece ee eee eee e ee ee eee ee ee ee ees 198 
一 个 与 运动 规划 和 控制 密切 相关 的 问题 。 11.2.2 dee 198 
本 音 首先 特别 回顾 了 面向 任务 的 运动 学 及 其 11.3 微分 道 运动 学 和 200 
速度 级 (一 阶 微分 ) 求 逆 的 基本 方法 ， 并 讨论 了 11.3.1 通 解 ee 200 
处 理 运 动 学 奇异 的 主要 方法 。 其 次 ， 把 不 同 的 求 11.3.2 奇异 点 的 鲁 梭 性 pp 200 
解 运动 学 元 余 的 一 阶 方法 分 成 两 大 类 ， 即 基于 适 11.3.3 关节 轨迹 重 构 rd pn re tas eioéi dun 203 
当 性 能 指标 的 优化 方法 和 基于 任务 空间 增 广 的 方 114 TRER remm 204 
法 。 为 考虑 例如 力矩 最 小 化 这 样 的 动力 学 问题 ， 11.4.1 性 能 指标 ee 204 
随后 讨论 了 加 速度 级 (二 阶 微分 ) AY TFS IER A 11.4.2 局 部 优化 :pp 204 
方法 。 还 讨论 了 由 关节 的 循环 运动 产生 循环 的 任 11.4.3 全 局 优化 和 204 
务 空间 运动 的 条 件 ， 这 是 一 个 重要 的 问题 ， 比 如 。 11.5 元 余 度 求解 的 任务 增 三 法 和 205 
在 工业 上 应 用 一 个 宛 余 机 械 辟 完 成 重复 性 任务 这 11.5.1 扩展 雅 可 比 和 矩阵 cee ee eee e eee ee ee eee ee ee ees 205 
样 的 场合 。 同 时 还 详细 分 析 了 超 宛 余 度 这 种 特殊 11.5.2 Tien] ABER n M 205 
类 型 的 机 械 臂 。 最 后 一 节 对 进一步 学 习 所 需 的 参 11.5.3 &ukTESg S eM 206 
考 读物 进行 了 推荐 。 11.5.4 任务 优先 级 M 206 
运动 学 宛 余 的 机 械 辟 具有 比 完成 任务 所 需要 的 11.6 BIA BRE MM 207 
更 多 的 关节 ， 这 使 机 器 人 拥有 更 多 的 灵巧 性 ， 这 不 11.7. 循环 性 208 
仅 可 用 于 实现 避 奇 异 、 避 关节 超 限 和 任务 空间 避 11.8 超 完 余 机 械 忌 cece e cece cence eee en eens 208 
fe 还 可 用 于 最 小 化 关节 力矩 、 最 小 化 能 量 消 11.8.1 刚性 杆 超 宛 余 设计 ………………… 208 
耗 ， 或 者 一 般 而 言 ， 优 化 某 种 适当 的 性 能 指标 。 11.8.2. PERRIEBLAE A BE enm 210 
11.8.3 超 宛 余 机 械 臂 建 模 MM 210 
11.9 GRU BPW ERB- eM 211 
11.1 BEOReeeee mmm LL HME o nem 212 


11.1 概述 


当 机 械 臂 具有 比 刚好 能 完成 给 定 任务 所 需要 的 自 
由 度 更 多 的 自由 度 时候 ， 就 具有 了 运动 学 元 余 度 。 这 
意味 着 ， 原 则 上 没有 什么 机 械 臂 是 本 质 上 宛 余 的 。 更 
准确 地 说 ， 是 存在 某 些 任务 ， 机 械 臂 针对 这 样 的 任务 
时 就 成 了 宛 余 的 。 因 为 众所周知 ， 一 般 的 任务 要 求 末 
端 执行 器 跟踪 一 个 运动 轨迹 ， 这 需要 6 个 自由 度 ， 所 
以 具有 7 个 或 更 多 关节 的 机 械 臂 被 当成 是 本 质 上 宛 余 
的 机 械 辟 的 典型 例子 。 但 具有 更 少 自由 度 的 机 器 人 ， 


比如 传统 的 六 关节 工业 机 械 臂 ， 对 于 某 些 任务 而 言 也 
可 能 成 为 运动 学 宛 余 的 ， 例 如 ， 只 是 简单 要 求 未 端 执 
行 器 的 位 置 而 对 姿态 没有 约束 的 任务 。 

传统 工业 设计 中 利用 宛 余 是 为 了 增加 对 故障 的 鲁 
棒 性 以 提高 可 靠 性 〈 比 如 处 理 器 或 传感器 元 余 ) E 
机 械 辟 的 机 械 结 构 上 引入 运动 学 元 余 的 目的 不 止 于 
此 。 实 际 上 ， 使 机 械 辟 具有 运动 学 元 余 的 主要 目的 是 
增加 灵活 性 。 

早期 机 械 辟 设计 方法 的 特点 是 具有 最 小 的 复杂 
性 ,设计 目标 是 最 低 的 成 本 和 维护 。 比 如 用 于 完 
拾 - 放 操作 的 平面 关节 型 机 械 臂 (SCARA)S 就 是 这 


名“ 译 者 注 : Selective Compliance Assembly Robot Arm， 有 时 也 直译 为 选择 顺应 性 装配 机 械 手 臂 。 
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设计 理念 的 产物 。 可 是 让 机 械 臂 只 具有 能 完成 任务 的 
最 少 关节 会 在 实际 应 用 中 导致 严重 的 局 限 性 ， 除 了 奇 
异 ， 还 会 遇 到 关节 超 限 或 工作 空间 障碍 问题 。 这 些 问 
题 都 将 使 关节 空间 中 的 禁区 增 大 ， 以 便 在 操作 过 程 中 
回避 。 这 就 需要 有 一 个 仔细 构造 的 且 是 静态 的 工作 空 
间 ， 机 械 辟 的 运动 可 以 事先 在 该 空间 中 进行 规划 ， 机 
器 人 设备 在 传统 工业 应 用 中 的 情况 就 是 这 样 的 。 

男 一 方面 ， 具有 比 执行 任务 所 需 更 多 的 自由 度 使 
机 械 辟 能 进行 所 谓 的 自 运 动 或 内 运动 ， 即 不 改变 末端 
执行 器 位 姿 的 机 械 臂 运动 。 这 意味 着 末端 执行 器 执行 
同样 的 任务 时 ， 关节 可 以 选择 多 种 不 同 的 运动 方式 ， 
有 可 能 避 开 禁区 ， 最 终 提高 设备 的 通用 性 。 这 种 特性 
是 在 非 结构 化 或 动态 环境 中 进行 操作 的 关键 ， 而 非 结 
构 化 或 动态 环境 正 是 先进 工业 应 用 和 服务 机 器 人 的 工 
作 环 境 。 

实际 上 ， 如 果 规 划 得 当 ， 以 增加 了 灵巧 性 为 特色 
的 运动 学 见 余 机 械 辟 有 可 能 实现 避 奇 异 、 避 关节 超 限 
和 工作 空间 避 障 ， 以 及 针对 特定 任务 最 小 化 力矩 /能 
耗 ， 本 质 上 意味 着 机 器 人 机 械 臂 能 达到 较 高 的 自治 
程度 。 

运动 学 见 余 机 械 辟 的 生物 原型 是 人 类 的 手臂 ,不 
用 惊讶 ， 手 臂 也 是 术语 学 上 命名 串联 结构 机 械 辟 的 灵 
感 来 源 。 实 际 上 ， 人 类 手臂 的 肩 部 有 3 个 自由 度 ， 肘 
部 和 腕 部 各 有 一 个 和 三 个 自由 度 。 国 定 你 的 腕 部 ， 比 
如 把 手腕 搁 在 桌子 上 并 在 肩 部 不 动 的 情况 下 移动 手 
肘 ， 就 可 以 很 容易 地 验证 手臂 具有 有 效 的 匈 余 度 。 许 
多 机 器 人 模仿 了 人 类 手臂 的 运动 学 配置 ， 并 被 称 为 类 
人 机 械 臂 。 包 括 DLR 轻型 机 器 人 ( 见 图 11. 1). 和 三 
AER] PA-10 机 器 人 (〈 见 图 11.2) 在 内 的 机 器 人 ， 形 
成 了 一 个 七 自由 度 机 械 臂 的 家 族 。 而 Scienzia Machi- 
nale 公司 的 DEXTER (参见 图 11.3) 则 是 一 个 八 自 
由 度 机 器 人 的 例子 。 有 大 量 关节 的 机 械 臂 常常 被 称 为 
“ 超 宛 余 度 ”机 器 人 ， 包 括 文献 中 描述 的 许多 蛇 形 机 
器 人 。 


图 11.1 七 自由 度 DLR 轻型 机 器 人 


图 11.3 Scienzia Machinale 公司 的 
八 自 由 度 机 械 辟 DEXTER 


使 用 两 个 及 以 上 机 器 人 设备 共同 执行 同一 项 任 
务 ， 比 如 多 机 械 臂 协调 和 多 指 手 ， 也 会 形成 运动 学 宛 
余 。 宛 余 装 置 还 包括 车 辆 -机 械 臂 系统 ， 不 过 这 种 情 
况 下 元 余 度 的 准确 计算 还 必须 考虑 车 辆 本 体 运 动 可 能 
出 现 的 非 完 整 约束 。 

虽然 要 制造 运动 学 元 余 的 设备 在 机 械 设计 方面 也 
会 出 现 一 些 问题 ， 但 本 章 专 注 于 讨论 元 余 度 求解 方 
法 ， 即 在 求解 逆 运 动 学 问题 时 利用 元 余 自由 度 的 技 
巧 。 这 是 一 个 与 运动 规划 和 控制 密切 相关 的 问题 。 
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机 器 人 结构 


11.2 面向 任务 的 运动 学 


描述 关节 型 机 械 臂 形态 的 变量 和 在 适当 空间 中 描 
述 给 定 任务 的 变量 之 间 的 坐标 关系 、 速 度 关 系 和 加 速 
度 关系 都 是 可 以 建立 的 。 尤 其 是 考虑 任务 的 一 阶 运动 
学 还 可 导出 任务 雅 可 比 和 矩阵 ， 它 是 匈 余 度 求解 方法 研 
究 的 主要 对 象 。 


11.2.1 任务 空间 方程 


机 械 辟 是 一 个 由 关节 连接 的 刚体 链 。 令 q 为 刚 
Ai 相对 于 刚体 ; -1 的 位 置 变量 ， 向 量 g = (q … 
qu) 就 唯一 地 表示 了 ON 关节 串联 机 械 臂 的 形态 。 关 
节 可 以 是 滑 移 关节 或 者 是 转动 关节 ，9; 根据 情况 分 
别 表 示 相 邻 连 杆 的 位 移 或 转角 。 

虽然 机 械 臂 在 “关节 空间 ”中 进行 表示 和 驱动 


则 下 面 的 关系 式 成 立 
t =T(t)vy (11.4) 
式 中 , 了 是 一 个 M x6 EM, CRIE t HR, 
“4M =6IN, FERRE T 的 形式 为 
ne 
0 R 
式 中 , 7 和 0 分 别 是 适当 维 数 的 单位 矩阵 和 零 矩 阵 ; 
R 是 一 个 3 x3 的 特定 矩阵 ， 由 描述 末端 执行 器 姿态 
的 表示 方式 决定 。 
对 一 个 特定 的 机 械 臂 ， 映 射 
vy 2J(q)q (11.6) 
通过 6 x N 的 几何 雅 可 比 矩 阵 了 把 关节 空间 速度 和 相 
应 的 末端 执行 器 速度 联系 起 来 了 。 几 何 雅 可 比 矩 阵 是 
机 械 臂 运动 学 分 析 主 要 的 研究 对 象 ， 因 为 可 以 通过 它 
根据 当前 形态 下 的 关节 速度 控制 量 ， 得 出 末端 执行 器 
的 运动 (表示 为 它 的 刚体 自由 空间 速度 ) 。 


(11.5) 


比较 自然 ， 但 要 方便 地 表示 它 的 操作 却 要 用 向 量 上 = 
(六 … 妃 六， 典型 的 情况 是 该 向 量 表示 了 机 械 臂 末端 
执行 器 在 一 个 适当 定义 的 任务 空间 中 的 位 置 。 一 般 情 
wR, M=6, ifii EL t 的 前 三 个 元 素 表 示 末 端 执行 期 位 
置 ， 而 后 三 个 元 素 则 是 末端 执行 器 姿态 的 某 种 最 小 描 
述 ( 比如 欧 拉 角 或 RPY 角 表 示 ) ， 也 即 
t=[p. B, pow B yp 

典型 的 情况 是 NSM, B8 TED ELE 
数 不 少 于 末端 执行 器 任务 所 需要 的 。 如 果 严 格 满足 
N >M， 机 械 辟 就 是 运动 学 见 余 的 。 

关节 空间 坐标 向 量 9 与 任务 空间 坐标 向 量 上 的 关 
系 可 以 表示 为 正 向 运动 方程 


t=k (q) (11.1) 
式 中 , k, 是 一 个 非 线 性 向 量 函 数 。 
1. 任务 雅 可 比 和 几何 雅 可 比 
考虑 一 阶 微分 运动 学 方程 "1 

t =J.(g)gq (11.2) 


x (11.2) 可 由 (11.1) 对 时 间 求 导 得 到 。 在 
式 (11.2) F, t 是 任务 空间 速度 向 量 ; q 是 关节 
空间 速度 向 量 ; J, (q) = 9k,/9g 是 M x N 的 任务 雅 可 
EIERE (也 称 为 解析 雅 可 比 )。 

值得 注意 的 是 ，1 中 关于 末端 执行 器 姿态 的 元 
素 表示 了 用 于 描述 姿态 的 参数 的 变化 速率 ， 而 不 是 末 
端 执行 器 的 角速度 向 量 。 其 实 , S vy 表示 末端 执行 
器 的 3 x1 平 动 速度 向 量 ，w， 表 示 3 xl 角速度 向 量 ， 
并 定义 未 端 执行 器 的 速度 v, H 


Vy 
We 
WN 


(11.3) 


对 比 式 (11.2) , X (11.4) MÈ (11.6), 可 
得 几何 雅 可 比 和 任务 雅 可 比 之 间 的 关系 为 
Ji(q) 2 T(O0J(Cq) 
2. 二 阶 微分 运动 学 
一 阶 微分 运动 学 式 (11.2) 表示 了 任务 空间 和 
关节 空间 速度 之 间 的 关系 ， 进 一 步 求 它 对 时 间 的 导数 
可 以 得 到 加 速度 的 类 似 关 系 


f =J, (4) q +J 4,4 )d 
上 式 也 被 称 为 二 阶 微分 运动 学 。 


(11.7) 


(11.8) 


11.22 奇异 


本 节 通 过 考虑 奇异 位 形 的 产生 原因 来 分 析 它 在 运 
动 学 逆 解 中 的 作用 。 

1. 表示 法 奇异 与 运动 学 奇异 

如 果 任 务 雅 可 比 和 矩阵 了 在 某 个 位 形 下 是 降 秩 的 ， 
则 这 个 机 器 人 位 形 q 是 奇异 的 。 考 虑 J, EN (11.2) 
和 式 (11.8) 中 的 作用 ， 容 易 理解 处 于 奇异 位 形 时 
无 法 产生 末端 执行 器 在 某 些 方向 上 的 速度 或 加 速度 。 
观察 式 (11.7) 可 发 现 更 深层 次 的 问题 ,奇异 可 能 
是 因为 变换 矩阵 T 和 几何 雅 可比 矩 阵 了 有 一 个 不 满 
秩 ， 或 者 都 不 满 秩 。 

TT 矩阵 的 不 满 秩 只 与 RR 建立 的 末端 执行 器 角速度 
向 量 和 上 中 关于 末端 姿态 的 分 量 之 间 的 数学 关系 有 
X. AAR 的 表达 式 决 定 于 所 用 的 姿态 表示 法 ， 导 
致 了 奇异 的 位 形 因而 被 认为 是 表示 法 奇异 点 。 值 得 
主意 的 是 ， 任 何 一 种 末端 执行 器 姿态 的 最 小 表示 都 会 
生 表示 法 奇异 。 当 然 对 于 一 个 特定 的 位 形 而 言 ， 会 
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不 会 产生 表示 法 奇异 是 由 所 采用 的 姿态 表示 方法 决 
定 的 。 

表示 法 奇异 与 机 械 臂 的 真实 运动 能 力 并 没有 直接 
关系 ， 真 实 运动 能 力 可 以 改 用 几何 雅 可 比 矩 阵 了 来 分 
析 。 该 矩阵 的 降 秩 实际 上 是 与 机 械 臂 末端 执行 器 运动 
能 力 的 缺失 相关 的 。 确 切 地 说 ， 此 时 某 些 末端 执行 器 
速度 是 用 任何 关节 速度 都 无 法 实现 的 。 使 得 了 奇异 的 
位 形 称 为 运动 学 奇异 点 。 

因为 本 章 主 要 关注 微分 运动 学 方程 (11.2) 和 
式 (11.8) RIÉ, BER RTE AN OF SE ES HE TT LER 
阵 和 它 的 奇异 (包括 表示 法 奇异 和 运动 学 奇异 ) 。 
考虑 N= M 的 情况 ， 以 涵盖 常规 机 械 辟 和 元 余 机 
BOF o 

2. JETI be 5B BEB at REEL RE 

为 了 分 析 式 (11.2) 表示 的 线性 映射 ， 可 对 雅 
可 比 矩 阵 进 行 奇异 值 分 解 (SVD)。 值 得 注意 的 是 ， 
奇异 值 分 解 是 一 个 强 有 力 的 数学 工具 ， 在 计算 矩阵 的 
秩 和 分 析 近 乎 奇异 的 线性 映射 时 ， 它 是 唯一 可 靠 的 方 
法 。 经 典 的 Golub- Reinsch 算法 "是 计算 任意 矩阵 
奇异 值 分 解 最 有 效率 和 数值 最 稳定 的 算法 ， 但 可 能 还 
是 难以 达到 实时 应 用 的 计算 要 求 。 参 考 文献 [11.3] 
提出 了 一 种 利用 机 器 人 和 矩阵 计算 特点 的 更 快 算法 ， 有 
可 能 用 于 提高 运动 学 实时 控制 方法 的 性 能 。 

任务 雅 可 比 矩 阵 的 SVD 可 以 写 为 如 下 形式 


J, = USV" = Mou! 
式 中 , U 是 输出 奇异 向 量 w 的 M x M EEEE; V 
是 输出 奇异 向 量 v, 的 NN x N 维 正 交 和 矩阵 ; X-(S 0) 
是 一 个 MxNN 维 的 矩阵 。 它 的 M x M AEX AARP IERE 
S 包含 矩阵 J 的 奇异 值 ri。 请 注意 SVD 是 其 矩阵 变 
量 的 连续 乖 函 数 ， 因 此 当 机 器 人 处 于 当前 位 形 附近 
时 ,输入 和 输出 奇异 向 量 以 及 奇异 值 的 差别 也 不 大 。 
SEREREK rank(J,) =R, WA 

g,29g,2 £g, >On, 7720 

R(J,) 2spaniu, ,unl 

N(J)) =span| VR, Vy] 

如 果 任 务 雅 可 比 矩 阵 是 满 秩 的 (R- M), MA 
的 奇异 值 都 非 零 ，J 的 值 空间 就 是 整个 的 R”，,， J 的 
零 空 间 的 维 数 为 N-M。 而 在 奇异 位 形 处 ，R < MM， 因 
此 最 后 M-R 个 奇异 值 等 于 零 ，J 的 值 空间 是 R" 的 R 
ATZE, J 的 零 空间 的 维 数 减 少 为 N-R。 下 面 从 运 
动 学 角度 对 此 给 出 一 种 解释 。 

(1) 可 达 速 度 ” 当 机器 人 处 于 某 一 个 位 形 时 ， 
J 的 值 空间 是 可 以 由 所 有 可 能 的 关节 空间 速度 g 计 
算得 到 的 任务 空间 速度 的 集合 。 因 此 ， 值 空间 就 组 


(11.9) 


成 了 所 谓 的 末端 执行 器 任务 的 可 达 速 度 子 空间 。 前 
RR 个 输出 奇异 向 量 就 构成 了 值 空间 AAJ) 的 一 个 基 
底 。 因 此 ， 奇 异 的 效果 是 从 可 达 速 度 空间 中 抹 去 了 
一 些 任务 速度 的 线性 组 合 ， 从 而 减少 了 J 的 值 空间 
的 维 数 。 

(2) 零 空 间 速 度 ”在 每 个 位 形 处 ,J 的 零 空间 
则 是 那些 不 产生 任务 速度 的 关节 空间 速度 的 集合 。 这 
样 的 关节 速度 因此 被 简称 为 零 空间 速度 。 后 N-R 个 
输入 奇异 向 量 构成 了 零 空 间 .A(J,) 的 一 个 基底 ， 这 
些 向 量 表示 每 个 关节 速度 的 线性 无 关 组 合 。 从 这 种 意 
义 上 说 ， 奇 异 的 效果 是 因为 引入 了 更 多 的 不 产生 任务 
速度 的 关节 速度 线性 无 关 组 合 ， 增 加 了 J, 的 零 空间 
的 维 数 。 
由 式 (11.2) 和 式 (11.9) 可 知 ,平行 于 第 i 个 
输入 奇异 向 量 的 关节 速度 所 产生 的 任务 速度 与 第 i 个 
输出 奇异 向 量 平行 : 

VpeR q =pv,>t=o,pu, (ERE: 此 公式 中 
的 t 应 为 1 的 导数 1 。 原 文 有 误 ) 

因此 ,J 的 第 i 个 奇异 值 可 以 看 成 是 一 个 增益 系 
数 , vb, 方 向 的 关节 速度 空间 运动 到 所 产生 的 方向 任 
务 速度 空间 运动 之 间 的 一 个 系数 。 当 机 器 人 靠近 某 个 
奇异 位 形 时 ,第 尺 个 奇异 值 mr, 趋 近 于 零 ， 由 沿 着 v, 
方向 的 给 定 大 小 关节 速度 所 产生 的 任务 速度 也 按 比例 
下 降 。 当 机 器 人 处 于 某 个 奇异 位 形 时 ， 沿 着 ve 
的 关节 速度 属于 零 空 间 速 度 ， 沿 着 ui 方向 的 任务 空 
间 速 度 变 得 无 法 实现 。 

一 般 情况 下 ， 关 节 空 间 速 度 g 是 在 所 有 vw, 方向 
上 都 含有 非 零 分 量 的 各 关节 速度 的 一 个 任意 的 线性 组 
合 。 总 的 效果 可 以 通过 合并 单个 上 述 分 量 的 效果 来 分 
析 。 值 得 注意 的 是 ，g 的 属于 J 零 空 间 的 部 分 会 引 
起 机 械 辟 位 形 的 变化 ， 却 不 改变 任务 空间 速度 。 这 种 
运动 可 以 用 于 在 实现 期 望 的 任务 运动 的 同时 实现 附加 
的 目标 ， 比 如 壁 障 或 避 奇 异 。 这 正 是 元 余 度 求解 算法 
研究 的 核心 内 容 。 

3. 到 奇异 点 的 距离 

奇异 不 仅 在 奇异 点 ， 而 且 在 奇异 点 相 邻 的 位 形 处 
都 会 造成 影响 ， 这 在 实际 经 验 中 确定 无 疑 。 因 此 ， 根 
据 某 种 适当 的 标准 来 表示 一 个 位 形 与 奇异 点 的 距离 就 
非常 重要 ， 可 以 用 来 避免 不 良 影响 。 

因为 每 个 奇异 点 都 与 J 的 降 秩 相关 ， 当 雅 可 比 
矩阵 为 方 阵 (MN) 时 ， 一 种 概念 上 很 简单 的 可 能 
方法 就 是 计算 它 的 行列 式 。 可 操作 性 指标 "就 是 这 
一 思路 对 非 方 阵 雅 可 比 的 一 个 推广 ， 其 定义 为 
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众所周知 ， 可 操作 性 等 价 于 上 的 奇异 值 的 乘 
积 ， 即 


H = Io 
因此 ， 它 的 零 值 就 对 应 着 奇异 。 
另 一 种 到 奇异 点 距离 的 合理 指标 是 雅 可 比 矩 阵 的 
APN! ， 定 义 为 


= 
Oy 


条 件数 的 取 值 范围 是 1 ~ oe 。 在 奇异 值 都 相等 的 
位 形 处 ， 取 值 为 1。 在 奇异 位 形 处 取 值 为 。 请 注意 
当 k=1 时， 所 有 奇异 值 都 是 相等 的 ， 因 此 末端 执行 
器 在 任务 空间 的 所 有 方向 上 的 运动 能 力 都 是 一 样 的 ， 
即 机 械 臂 处 于 一 种 各 向 同性 的 位 形 ， 而 在 奇异 点 处 则 
在 任务 空间 的 某 些 方向 上 丧 失 了 活动 能 力 。 

种 更 直接 的 描述 与 奇异 位 形 的 距离 的 指标 是 雅 

可 比 和 矩阵 的 最 小 奇异 值 " 引 ， 即 

最 小 奇异 值 可 以 通过 计算 量 较 小 的 方法 进行 估 
计 ， 包 括 数值 方法 ”7 或 基于 机 器 人 结构 运动 学 
分 析 的 方法 "1。 

必须 注意 ， 条 件数 或 J 的 最 小 奇异 值 差别 很 大 
的 时 候 ， 可 操作 性 指标 却 可 能 保持 不 变 。 男 一 方面 ， 
因为 在 奇异 点 附近 最 小 奇异 值 的 变化 比 其 他 奇异 值 更 
快 ， 它 会 对 雅 可 比 矩 阵 行列 式 和 条 件数 的 变化 起 主导 
作用 。 因 此 ， 描 述 到 奇异 位 形 距 离 的 最 有 效 指标 就 是 
J, 的 最 小 奇异 值 “” 。 


11.3 ”微分 逆 运 动 学 


p 


为 完成 一 项 任务 ， 必 须 控制 机 械 臂 关 节 作 适当 的 
和 运动。 因此， 推导 出 可 根据 给 定 的 任务 空间 量 计算 出 
关节 空间 量 的 数学 关系 非常 必要 。 这 也 正 是 逆 运 动 学 
问题 研究 的 目标 。 

道 运动 学 问题 可 以 通过 正 运动 学 方程 (11.1), 
一 阶 微分 运动 学 (11.2) 或 二 阶 微分 运动 学 方程 
(11.8) 求 逆 来 求解 。 如 果 任 务 是 时 变 的 〈 即 如 果 给 
定 了 形式 为 t(1) 的 期 望 轨迹 ) ， 则 因为 微分 运动 学 
关系 表示 为 以 任务 雅 可 比 为 系数 矩阵 的 线性 方程 组 ， 
H AFERE 1。 


通 解 
假设 机 械 臂 是 运动 学 宛 余 的 〈 即 M « N), 式 


(11.2) 或 式 (11.8) 的 通 解 可 以 借助 任务 雅 可 比 矩 
MEAS pu Jogos Us px ded d UF Moore- 


11.3.1 


Penrose 条 件 的 唯一 矩阵 
JJM, -J, 
JIJ =J 
QD" -J4! 
(QUO =I, 
JR. JERKIE ELE, Du EC DT HR A 
计算 


(11. 10) 


Js ug (11. 11) 
如 果 J, 是 方 阵 , SX (11. 11) IEE rE REF 
st (11.2) 的 通 解 可 以 写 为 
q -Jii «(0-JJ)4 (11,125 
式 中 , r-JU JE J, 零 空间 中 的 正 交 上 映射; % 是 一 个 任 
意 的 关节 空间 速度 。 因 此 解 的 第 二 部 分 是 一 个 零 空 间 
速度 。 式 (11.12). 给 出 了 满足 末端 执行 需 任 务 约 束 
(11.2) 的 所 有 最 小 二 乘 解 ， 即 最 小 化 上 i -yd | 的 
解 。 尤 其 当 J, 是 满 秩 长 方 和 矩阵 时 ， 式 (11.12). 表示 
的 所 有 关节 速度 都 能 正确 实现 给 定 的 任务 速度 。 通 过 
调节 qg,， 还 可 以 得 到 能 产生 相同 末端 执行 器 任务 速 
度 的 不 同 关节 速度 。 因 此 ， 就 像 后 面 将 详细 讨论 的 那 
样 ， 宛 余 度 求解 的 相关 文献 一 般 都 采用 式 C11. 12) 
形式 的 解 。 
在 式 (11.12) "P, 4 q, =0 可 以 得 到 特 解 
q-Ji (11.13) 
该 特 解 是 式 (11.2) 的 最 小 范 数 的 最 小 二 乘 解 ， 
被 称 为 伪 道 解 。 对 于 道 微分 运动 学 问题 ， 最 小 二 乘 特 
性 保证 了 末端 执行 器 任务 实现 的 精度 ， 而 最 小 范 数 可 
能 与 关节 空间 速度 的 可 行 性 相关 。 
对 于 二 阶 运动 学 方程 (11.8) ， 它 的 最 小 二 乘 解 
可 以 表示 为 如 下 的 一 般 形式 
d -J(É -44)s0-JJ) Gy (11.14) 
式 中 ，g6 是 一 个 任意 的 关节 空间 加 速度 。 如 上 所 述 ， 
fest (11.14) "B, > gw 20 可 以 得 到 最 小 范 数 加 速 
度 解 


d =J'(t -A4) 

11.3.2 ”奇异 点 的 鲁 棒 性 
现在 来 研究 一 阶 逆 映 射 (11.12) 和 (11.13) 
与 奇异 点 处 理 所 涉 及 的 运动 学 方面 的 问题 。 人 参考 式 
(11.9) PJ, 的 奇异 值 分 解 ， 考 虑 矩阵 THO Pop ie 
by sra 


i=l 


AP, R 是 如 上 所 述 表 示 任 务 雅 可 比 矩 阵 的 秩 。 类 似 


(11.15) 


J! = VXU = (11.16) 
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式 (11.9) ， 有 以 下 式 子 : 
g,Z2g,2 0R > Opg, 7:720 
RI) =A (J,) = span| v, Ve} 
MS) = 2° (J) = span | Up, sty 

WET, SRE AT be BR, TB EL zs n] 
R^ 中 的 一 个 好 AEF ZS TA, SES ARS AY, ME 
APE (R<M), JEZER * 中 的 一 个 RR 
维 子 空间 ，J 玫 存在 一 个 M-R EIFS H, 

大 的 值 空间 是 关节 空间 速度 4 的 一 个 集合 ， 
以 根据 所 有 可 能 的 任务 速度 上 ,由 逆 运 动 学 映射 
(11.13) 计算 得 到 。 因 为 这 些 gq 属于 J 的 零 空间 的 
正 交 补 ， 正 如 所 和 希望 的 那样 ， 伪 逆 解 (11.13) 满足 
最 小 二 乘 条 件 。 

扰 的 零 空 间 是 一 个 在 当前 位 形 产 生 零 关节 空间 速 

度 的 任务 速度 上 的 集合 。 另 一 方面 ， 这 些 上 属于 可 
达 任 务 速 度 空 间 的 正 交 补 。 因 此 ， 伪 逆 解 (11.13) 
的 一 个 效果 是 滤 除 任务 速度 指令 中 不 可 实现 的 分 量 ， 
而 留 下 可 精确 跟踪 的 可 达 分 量 ， 这 是 和 伪 逆 解 的 最 小 
范 数 最 小 二 乘 特 性 相关 联 的 。 
如 果 给 定 的 任务 速度 是 沿 着 u, 方向 的 ， 则 相应 
的 关节 空间 速度 (由 式 (11.13) 计算 得 到 的 ) op 
行 于 v;,， 并且 长 度 乘 以 系数 1/o;。 接 近 奇 异 点 时 ， 
BRAS, up 方向 一 定 大 小 的 任务 速度 
所 需要 的 内 方向 的 关节 空间 速度 大 小 与 系数 /ex 与 
成 比例 ， 将 无 限 增 大 。 处 于 奇异 点 时 ，mx 方向 对 任 
务 变量 来 说 不 可 实现 ， 凤 成 了 机 械 臂 的 零 空间 速度 
Zs 
由 以 上 分 析 可 知 ， 有 两 个 主要 问题 与 基本 的 微分 
道 运动 学 解 (11.13) 有 着 本 质 上 的 联系 ， 即 : 

1) 接近 奇异 位 形 时 ， 可 能 需要 超大 的 关节 空间 
速度 ， 原 因 是 i 的 一 些 分 量 处 于 这 样 的 方向 上 ， 即 
在 奇异 点 处 不 可 实现 的 方向 。 

2) 处 于 奇异 位 形 时 ， 如 果 上 包含 非 零 的 不 可 达 


的 适当 指标 来 实现 ， 而 且 改 进 的 映射 必须 保证 关节 速 
度 是 连续 的 和 可 实现 的 。 


1. 规划 轨迹 修正 

处 理 奇异 点 问题 的 一 种 方法 是 在 规划 阶段 就 让 轨 
迹 避 开 无 法 消除 的 奇异 点 ， 或 者 说 只 赋 给 机 器 人 手臂 
可 实现 的 任务 空间 运动 指令 。 然 而 ， 这 种 方法 依赖 于 
理想 的 轨迹 规划 ， 无 法 在 实时 的 传 感 控 制 中 应 用 ， 因 
为 实时 控制 时 运动 指令 是 在 线 生成 的 。 

对 于 任务 空间 中 国定 的 奇异 点 ， 比 如 类 人 手 
臂 的 肩 部 奇异 ， 在 运动 规划 阶段 避 开 奇异 位 形 相 
对 简单 。 但 是 ， 对 于 那些 有 可 能 在 工作 空间 的 任 
何 地 方 出 现 的 奇异 ， 比 如 腕 部 奇异 ， 这 种 方法 就 
难以 实现 。 

解决 奇异 问题 的 另 一 种 可 能 的 方法 是 当 机 械 臂 接 
近 奇 异 点 时 进行 关节 空间 插值 入” 。 不 过 ， 这 种 方 
法 有 可 能 在 跟踪 之 前 指定 的 任务 空间 运动 时 产生 很 大 
的 误差 。 

参考 文献 [11.5] 提出 了 一 种 作用 在 任务 空间 
的 、 基 于 时 间 尺 度 变 换 的 方法 。 这 种 方法 令 机 械 辟 在 
接近 奇异 点 时 降低 运动 速度 。 但 当 机 器 人 处 于 奇异 点 
时 ， 这 种 方法 就 失效 了 。 

因为 基于 任务 空间 的 机 器 人 控制 系统 必须 能 控制 
机 械 辟 安全 地 通过 奇异 点 ， 大 量 研究 转向 了 推导 定义 
明确 的 连续 的 逆 运 动 学 映射 。 

2. 消除 雅 可 比 矩 阵 中 线性 相关 的 行 / 列 

求解 式 (11.13) 首先 要 求 当 雅 可 比 奇 异 时 ， 
计算 J, 的 伪 闭 的 一 般 算 法 是 有 效 的 。 文 献 中 提出 了 
一 些 算 法 属于 这 样 一 种 模式 ， 消 除 不 可 实现 的 末端 
参考 运动 分 量 " "1 ， 或 是 使 用 雅 可 比 矩 阵 的 非 奇异 
ApH) 。 这 类 方法 的 主要 问题 是 要 用 一 种 系统 性 
的 方法 求 出 不 可 达 速 度 的 方向 ， 以 及 需要 在 常规 的 
和 用 于 奇异 点 附近 的 道 运 动 学 算法 之 间 进 行 平滑 
切换 。 

一 种 计算 雅 可 比 矩 阵 伪 闭 的 系统 性 方法 可 以 


= 


分 量 ， 则 关节 空间 解 将 不 存在 。 

这 两 点 对 于 完整 的 逆 解 (11.12) 显然 也 是 一 
样 的 。 

上 述 两 个 问题 都 是 机 械 辟 运动 学 控制 主要 关心 的 
问题 ， 控 制 中 要 求 计 算出 的 关节 空间 速度 必须 是 机 器 
人 手臂 能 够 实际 实现 的 才 行 。 针 对 上 述 问题 ， 发 展 出 
了 改进 的 微分 道 映射 ， 以 确保 机 械 臂 在 整个 工作 空间 
中 行为 适当 。 一 种 合理 的 方法 是 远离 奇异 点 时 仍然 使 
用 映射 (11.13), ， 只 在 奇异 位 形 附近 的 区 域内 对 该 
映射 进行 改动 。 区 域 的 定义 则 要 靠 描述 到 奇异 点 距离 


利用 对 机 械 臂 结构 的 运动 学 分 析 来 建立 ， 因 为 对 
于 典型 的 机 械 臂 ， 有 可 能 在 适当 地 与 连 杆 固 接 的 
动 坐标 系 中 辨识 和 描述 奇异 位 形 的 类 别 。 参 考 文 
BK [11.17, 18] 针对 六 自由 度 肘 关节 形式 的 机 械 
臂 描 述 了 这 种 方法 。 

要 在 穿越 奇异 点 时 保持 解 的 连贯 性 ， 需 要 注意 的 
是 ， 机 械 臂 在 奇异 点 附近 时 奇异 向 量变 化 非常 小 ， 但 


在 奇异 位 形 处 时 RR 变 得 比 M 小 ， vu) i 项 突然 从 
M 


st (11.16) 中 消失 了 。 
一 种 可 能 的 避免 这 


问题 的 方法 是 在 奇异 点 附近 
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令 wit ~0， 这 意味 着 去 除 奇异 时 不 可 达 的 方向 上 的 
任务 速度 指令 。 不 过 ， 如 11.3.2 节 所 述 ， 这 种 方法 
只 有 在 针对 任务 空间 中 国定 的 奇异 点 的 轨迹 预先 规划 
时 ， 才 可 以 合理 运用 。 
无 论 给 定 的 1 是 什么 ， 伪 逆 解 的 连贯 性 都 可 以 
这 样 来 确保 : 在 适当 定义 的 奇异 点 邻 域内 将 机 械 臂 视 
为 奇异 ,将 雅 可 比 修改 为 J ， 因 而 可 得 M-R 个 额外 
的 自由 度 下 "~ 中 。 这 不 会 对 末端 执行 器 速度 有 太 大 
影响 ， 因 为 修正 的 雅 可 比 了 在 领域 内 趋 近 于 J o 
这 种 方法 难以 用 于 多 重 奇异 点 。 但 对 于 典型 的 类 人 结 
构 的 工业 机 械 臂 ， 需 要 主要 关心 的 只 有 腕 部 奇异 ， 因 
为 腕 部 奇异 可 能 在 工作 空间 的 任何 地 方 出 现 ， 而 肘 部 
和 肩 部 奇异 在 任务 空间 中 是 固定 的 ， 因 而 可 以 通过 规 
划 来 避 开 。 
3. 正则 化 /阻尼 最 小 二 乘法 
参考 文献 [119, 20] 各 自 独 立地 提出 了 将 阻 
尼 最 小 二 乘法 用 于 微分 逆 运 动 学 问题 的 方法 。 这 种 方 
法 相当 于 求解 方程 
Ji - (UJ, +AD)g (11.17) 
而 不 是 式 (11.2)。 式 中 , Ae R 为 阻尼 系数 。 可 以 
验证 ， 当 和 WAT, 式 (11.17) MÈ (11.2) 就 是 
一 样 的 了 。 
sk (11.17) 的 解 可 以 写 为 两 种 等 价 的 形式 : 
q =J JJ, +AD)t 
q= (JJ «XD Jt (11.19) 
x (11.18) 的 计算 量 小 于 式 (11.19) 的 ， 因 
为 一 般 而 言 Y=M。 下 文 在 不 需要 显 性 描述 计算 过 程 
的 地 方 ， 将 把 阻尼 最 小 二 乘 解 归 结 ; 


(11.18) 


q-J/ (pt (11.20) 
解 式 (11.20) 满足 以 下 条 件 
minz([t -Jg F «A gl) (1.21) 


该 条 件 实现 了 最 小 二 乘 特 性 和 最 小 范 数 特性 的 折 中 。 
条 件 (11.21) 意味 着 在 求 给 定 t 所 需要 的 关节 空间 
速度 时 ， 同 时 考虑 精度 和 可 实现 性 。 在 这 点 上 ， 适当 
选择 阻尼 系数 非常 关键 : 较 小 的 A 值 能 给 出 精确 解 ， 
但 对 奇异 点 和 近 奇 异 点 位 形 的 鲁 棒 性 较 差 ， 较 大 的 A 
值 会 导致 跟踪 精度 较 低 ， 即 使 是 在 精确 可 行 解 可 能 存 
的 时 候 。 

按照 奇异 值 分 解 的 模式 ， 解 (11.20) 可 以 写 为 


. T; pe 


i=l 


请 注意 ， 下 式 成 立 


RIE) =R) =A (7) =span| v, ve} 5 

MI) =M SF) =R (t) =span | Ug, Uy} o 

类 似 于 于 ， 如 果 雅 可 比 矩 阵 满 秩 ，J* 的 值 空间 
是 R” 中 的 M 维 子 空间 ， 并且 JE 的 零 空间 是 空 的 ; 
而 在 奇异 位 形 处 ，J 的 值 空间 是 RR” 中 的 RETE 
间 ， 并 且 存 在 一 个 M- R 维 的 零 空间 。 

显然 ， 相 比 于 纯粹 的 最 小 二 乘 解 (11.13 ) ， 解 
(11.22) 中 满足 o; >> A 的 部 分 受阻 尼 系 数 的 影响 较 
小 ， 因 为 此 时 有 


un 1 


c; +A? ar 

另 一 方面 ， 当 遇 到 奇异 点 时 ， 最 小 奇异 值 趋 于 
零 ， 而 解 的 相关 部 分 被 系数 o / A 强制 为 零 ， 这 就 逐 
渐 减 少 了 为 实现 期 望 上 中 接近 退化 的 部 分 所 需 的 关 
节 速 度 。 在 奇异 点 ， 只 要 剩余 奇异 值 比 阻尼 系数 大 得 
£, fW (1120) 和 解 (11.13) 的 行为 就 是 一 致 的 。 
请 注意 ， 归 因 于 阻尼 系数 ，1/(2A) 的 上 界 依赖 于 一 
个 增益 系数 ， 第 i 个 系数 是 uu 方向 的 任务 速度 分 量 和 
它 产生 的 vw 方向 关节 速度 之 间 的 系数 ， 当 o, =A 时 ， 
达到 该 上 界 。 

(1) 阻尼 系数 选取 由 上 所 述 ， 选 取 的 阻尼 系 
数值 给 定 了 当前 位 形 与 奇异 点 的 接近 程度 ; WE, A 
决定 了 与 伪 逆 给 出 的 纯 最 小 二 乘 解 的 相似 程度 。 和 的 
优化 选取 需要 考虑 给 定 轨迹 上 的 最 小 非 零 奇异 值 ， 并 
考虑 确保 可 实现 关节 速度 的 最 小 阻尼 。 
为 了 在 机 械 辟 的 整个 工作 空间 中 实现 出 良好 的 
性 能 ， 参 考 文献 [11.9] 提出 让 阻尼 系数 随 位 形变 
化 。 普 通 的 方法 是 把 和 作为 机 器 人 手臂 当前 位 形 到 
奇异 点 距离 的 一 个 函数 来 调节 。 远 离奇 异 位 形 时 解 
出 的 关节 速度 是 可 达 的 ; 因此 精度 要 求 占 主导 ， 应 
使 用 较 小 的 阻尼 。 接 近 奇 异 点 时 ， 不 可 达 方 向 的 任 
务 速度 指令 将 导出 很 大 的 关节 速度 ， 因 此 精度 要 
求 应 该 放松 ; 在 这 种 情况 下 ,需要 使 用 较 大 的 
阻尼 。 

参考 文献 [11.9] 提出 把 阻尼 系数 当成 可 操作 
性 指标 的 函数 来 调节 。 因 为 雅 可 比 矩 阵 的 最 小 奇异 值 
是 描述 到 奇异 点 位 形 距离 更 有 效 的 指标 [11.5], F 
文 将 考虑 用 它 来 构造 可 变 的 阻尼 系数 。 

如 果 能 得 到 最 小 奇异 值 的 估计 值 Ey, BJE RZ 
可 选 为 下 式 " "| 


0 MG meli 


[1-7 ($v/e) JA T. 其 他 


2 


r= 


(11.23) 
上 述 阻 尼 系 数 能 确保 解 的 连续 性 和 良好 形态 。 在 式 
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(11.23) "B, e 定义 了 奇异 区 域 的 大 小 ， 在 此 区 域内 
施加 阻尼 ; A,, 则 设 定 了 阻尼 系数 的 最 大 值 ， 在 奇异 
点 处 取得 该 值 。 

(2) 数字 滤波 ”由 式 (11.22) AA, 阻尼 系数 
在 所 有 末端 执行 器 速度 分 量 上 都 影响 解 的 精度 ,但 其 
实 末端 执行 器 速度 只 有 在 不 可 达 方 向 上 的 分 量 才 导致 
跟踪 能 力 的 损失 。 为 了 克服 这 个 问题 ,参考 文献 
[11.6] 提出 了 对 末端 执行 器 速度 分 量 进行 选择 性 滤 
波 的 方法 。 方 法 可 如 下 推导 : 如 果 可 以 得 到 输出 奇异 
向 量 的 一 个 估计 ， 此 处 的 输出 奇异 向 量 是 与 形成 不 
可 达 分 量 的 最 小 的 M-K 个 奇异 值 相关 的 ， 解 就 可 以 


写 为 如 下 形式 

q =T (TT +AT+B Xd) ')-'£ (11.24) 
式 中 , BR 1 沿 着 不 可 达 分 量 方 让 给 出 阻尼 的 最 大 分 
量 。 这 也 可 以 由 下 式 来 验证 


(11.25) 
其 中 的 近似 是 因为 式 (11.24) 使 用 的 是 估计 值 在.。 
请 注意 K<R; 但 哪怕 输出 奇异 向 量 的 估计 不 正确 ，A 
也 要 保持 非 零 值 以 保证 满足 映射 (11. 24) 的 条 件 。 

同样 地 ， 对 于 由 与 最 小 奇异 值 相关 的 输入 奇异 向 
生成 的 关节 速度 分 量 ， 可 以 施加 附加 的 阻尼 。 因 为 
这 样 的 速度 分 量 接 近 于 零 空间 速度 ”i。 解 的 一 般 
形式 为 


dcs 


= 


q = (TJ + XI +e Xu aua 
RP, B 只 沿 着 -天 个 零 空 ER DAHER E C 
出 阻尼 的 最 大 分 量 。 这 也 可 以 由 下 式 来 验证 


天 R 


E oO mis: O. T* 
q^ > i yut 4 > ;—ÀáÀ uit 
2 2' 1E 2 2 i^i 

i390; +A ism 0; +A +B 


(11.27) 
其 中 的 近似 也 是 因为 式 (11.26) E T fhitfü v. 
同样 ， 在 这 种 情况 下 ， 即 使 输入 奇异 向 量 的 估计 不 正 
Wh, A 也 要 保持 非 零 值 以 保证 满足 映射 (11.26) 的 
条 件 。 
对 比 式 (11.27) 和 式 (11.25) 可 以 看 出 , 在 
奇异 向 量 估 计 精 确 的 情况 下 , 解 (11.24) 和 解 
(11.26) 相等 。 


11.3.3 关节 轨迹 重 构 
在 求解 一 阶 微分 逆 运 动 学 时 ， 可 得 到 与 给 定 的 末 
端 执行 器 任务 速度 曲线 i (1) 相应 的 关节 速度 曲线 


但 是 ， 机 器 人 运动 控制 器 除了 参考 关节 速度 
需要 参考 位 置 轨迹 。 根 据 由 末端 执行 器 速度 曲线 


t (1) 得 到 的 关节 速度 曲线 重 构 出 关节 位 置 曲线 ， 就 
实现 了 运动 学 求 道 ， 这 可 以 看 成 是 一 种 逆 运 动 学 
算法 。 

如 果 关 节 速 度 曲线 完全 确定 (比如 通过 它 的 解 
析 式 确定 ) ， 相 应 的 关节 位 置 曲线 可 以 通过 对 时 间 积 
分 来 得 到 ， 即 


i SS 


40) = 4%) fadar (11.28) 


不 过 ， 机 器 人 控制 系统 的 数字 化 实现 使 得 得 到 关 
节 速 度 的 离散 序列 q EATE, qA t, 时 刻 对 计算 
得 到 的 关节 速度 的 采样 ， 即 

q =q (t,) 

由 于 这 一 原因 ， 必 须 提 出 连续 时 间 积 分 (11.28) 
的 离散 时 间 近 似 方 法 。 


连续 时 间 积 分 准确 的 离散 时 间 近 似 通常 需要 在 插 
值 算法 的 复杂 性 和 时 间 步 长 之 间 进 行 折 中 。 在 实时 应 


用 场合 ， 比 如 机 器 人 运动 控制 ， 高 阶 插值 会 造成 大 的 
时 延 ， 降 低 控制 回路 的 动态 性 能 。 这 种 时 延 可 以 通过 
适当 缩短 时 间 步 长 来 减少 。 无 论 如 何 ， 如 果 低 阶 插值 
也 能 得 到 可 以 接受 的 数字 积分 精度 ， 时 间 步 长 也 就 足 
够 短 了 。— 典 型 的 情况 是 一 阶 插值 ， 比 如 欧 拉 前 向 积分 
法 把 积分 (11. 28) 转化 为 

Gq. = AW + È iA 
AP, A 是 时 间 步 长 。 方程 (11.29) 一 般 写 为 更 有 
效率 的 递 推 形式 


(11. 29) 


Gi 74,4 +q- AM 
不 论 使 用 哪 种 持 值 法 ， 每 一 步 数值 积分 都 存在 虽 
然 很 小 但 却 避 免不了 的 误差 ,误差 还 会 累积 ， 导 致 重 
构 曲 线 与 精确 的 关节 位 置 曲线 之 间 的 长 期 漂移 。 影 响 
所 有 积分 重 构 方法 的 男 一 个 误差 源 是 关节 位 置 初 始 值 
可 能 有 误差 。 

克服 这 些 问 题 的 计算 方法 基于 反馈 修正 项 的 使 
用 ， 被 称 为 闭环 道 运动 学 (CLIK: closed- loop inverse 
kinematics) 。 例 如 一 阶 运动 学 的 情况 , 大 时 刻 关 节 速 
度 可 由 下 式 计 算 (对 比 式 (11.12) ) 


出 


pr 


5 i : 
q= (q) {tk KD -k (q,)]} + (11.30) 
[1-J1(4,)J,(4,) ldo 
式 中 , KESEREK ROMAE E, 
二 阶 CLIK 算法 也 能 用 于 求解 关节 位 置 、 


速度 和 
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加 速 SE") | CLIK 算法 最 初 是 在 参考 文献 
[11.26] 和 [11.27] 中 提出 的 ， 方 法 用 雅 可 比 的 转 
置 代 替 了 伪 道 ， 这 可 以 显著 减少 计算 量 并 可 用 于 固有 


11. 28 
奇异 点 ”|。 


11.4 元 余 度 求解 的 优化 法 


对 于 运动 学 宛 余 的 机 械 臂 ， 逆 运动 学 问题 可 以 有 
无 穷 多 解 ， 因 此 需要 一 个 对 解 进 行 选择 的 指标 。 本 节 
考虑 在 一 阶 微分 运动 学 层次 上 的 元 余 度 求解 的 优化 
法 。 在 讨论 关节 速度 计算 的 算法 性 策略 之 前 ， 先 简单 
回顾 一 下 可 能 的 性 能 指标 。 

性 能 指标 

具有 比 完成 给 定 任务 所 需 自 由 度 更 多 的 自由 度 的 
能 力 ， 可 以 用 于 在 运动 过 程 中 提高 性 能 指标 。 这 样 的 
上 标 可 能 只 依赖 于 机 器 人 关节 位 形 ， 或 者 还 与 速度 或 
加 速度 有 关 。 

在 能 够 通过 定义 适当 指标 来 追求 的 附加 目标 中 ， 
最 重要 的 可 能 是 避 奇 异 。 实 际 上 ， 引 入 运动 学 元 余 
的 一 个 主要 原因 就 是 要 减少 工作 空间 中 ， 机 械 辟 必 
须 处 于 奇异 位 形 才能 达到 的 区 域 ， 这 样 的 奇异 位 形 
被 称 为 不 可 避 奇 异 点 。 宛 余 机 械 臂 中 的 可 避 和 不 可 
避 奇 异 点 的 讨论 可 参见 参考 文献 [11. 29] 。 如 果 给 
定 的 末端 执行 器 任务 不 经 过 不 可 避 奇 异 点 ， 原 则 上 
总 是 有 可 能 算出 一 条 关节 轨迹 ,任务 雅 可 比 J 沿 着 
这 条 轨迹 是 连续 满 秩 的 。 为 实现 这 一 目标 ， 可 能 的 
性 能 指标 就 是 11. 2. 2 节 介 绍 的 描述 到 奇异 点 距离 的 
那些 独立 于 位 形 的 函数 ， 即 可 操作 性 、 条 件数 和 
的 最 小 奇异 值 。 在 运动 过 程 中 使 这 些 函 数 最 大 化 
(或 保持 尽 可 能 大 的 值 ) 是 在 运动 中 避 开 奇异 位 形 
的 合理 方案 。 

因为 运动 学 求 逆 在 奇异 位 形 的 邻 域内 会 产生 趋 于 
无 穷 大 的 关节 速度 ， 一 种 概念 上 有 所 不 同 的 方法 就 是 
最 小 化 宛 余 度 求解 所 生成 的 关节 速度 的 范 数 。 不 过 ， 
只 有 当 该 范 数 在 机 械 臂 的 所 有 运动 中 都 最 小 化 时 ， 这 
种 方法 才能 保证 避 开 奇异 点 。 范 数 的 局 部 极 小 中 
对 于 避 奇 异 没 有 任何 实际 意义 '"”]。 

匈 余 度 还 可 以 用 于 使 机 械 辟 连 杆 机 构 避 开 一 些 不 
受 欢迎 的 关节 空间 ， 比 如 机 械 性 的 关节 限制 ， 这 是 机 
器 人 机 械 辟 典型 存在 的 ， 可 以 通过 最 小 化 如 下 代价 函 
BOR EFF 


1x a ee 
H(q) = +> qi = qi mid ) 
1 imax T imi 


pml FES i AA BH NE TAL 


11.4.1 


z 


qi ma 是 该 范围 的 中 点 。 壁 障 是 元 余 度 的 另 一 项 有 意思 
的 应 用 ， 它 可 以 通过 最 小 化 适当 的 人 工 势 场 来 实现 ， 
人 工 势 场 函 数 基 于 障碍 区 域 在 位 形 空间 中 的 投影 来 
定义 [3132] 

文献 中 还 提出 了 很 多 其 他 的 性 能 指标 ， 其 中 一 些 
将 在 11.6 节 和 11.9 节 中 提 到 。 


11.4.2 局 部 优化 


局 部 优化 的 最 简单 形式 可 以 用 伪 逆 解 (11.13) 
来 表示 。 它 给 出 了 满足 任务 约束 的 关节 速度 中 范 数 最 
小 的 那个 。 显 然 ， 由 局 部 最 优 解 生 成 的 关节 运动 不 是 
机 械 臂 所 有 可 能 的 运动 中 速度 最 小 的 。 这 意味 着 ， 尽 
管 局 部 最 小 化 了 关节 速度 ,还 是 不 能 确保 避 开 
2 LAM 

使 用 通 解 (11.12). 的 另 一 种 可 能 方法 是 选取 需 
要 最 小 化 的 性 能 指标 五 (gq) ， 在 它 的 反 梯 度 方向 上 选 
取 任 意 的 关节 速度 qo: 

d, = - ky V H(q) (11.31) 

式 中 ,三 是 一 个 步 长 标量 ; VH(q) 是 指 五 在 当前 

关节 位 形 的 梯度 。 这 种 方法 可 引出 下 面 的 宛 余 度 求解 
VEL MU 

q =J't -k,(1I-J)VH(q) (11.32) 

因为 式 (11.32) 的 第 二 项 是 五 的 反 梯 度 在 雅 可 
比 和 矩阵 零 空 间 中 的 投影 ， 上 式 让 人 想起 了 约束 最 小 化 
问题 中 的 梯度 投影 法 '"" 引 。 尤 其 是 参考 文献 
[11.34] 显示 ， 首 运动 学 解 (11.32) 在 当前 位 形 q 
处 ， 最 小 化 了 完全 二 次 方程 

L(g, d) = 六 gd - lud VHC) 

因此 , 3X (11.32) 代表 了 性 能 指标 H 的 无 约束 局 
部 最 小 化 〈 这 将 导致 选取 4 = -kV H(q)), ， 和 通过 最 
小 范 数 关节 速度 来 满足 约束 (11.2) 之 间 的 折 中 。 

步 长 ,的 选择 对 于 宛 余 度 求解 算法 (11.32) 的 
性 能 非常 关键 。 特 别 是 ， 较 小 的 步 长 值 可 能 降低 性 能 
§ 标 最 小 化 的 速度 ， 但 另 一 方面 ， 较 大 的 值 甚至 可 能 
导致 五 反而 增加 (回想 一 下 ， 反 梯度 只 是 局 部 的 最 
快 下 降 方向 )。 实 际 上 ， 要 为 每 个 位 形 在 适当 的 时 间 
内 确定 一 个 入 值 ， 可 以 使 用 简化 的 线 搜索 技术 ， 比 
如 Armijo 规则 各 -31 。 


11.4.3 全 局 优化 


宛 余 度 解 法 (11.32) 的 主要 优点 是 简单 : 如 果 
VH(q) 和 名 的 计算 是 有 效率 的 ， 它 就 是 实时 运动 
学 求 道 可 以 实际 采用 的 一 种 方法 。 它 的 缺点 在 于 优化 
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过 程 的 局 部 性 ， 这 可 能 在 较 长 时 间 的 任务 中 造成 不 令 
人 满意 的 性 能 ， 比 如 ,使 用 式 (11.32) WR H = 
-可 操作 性 ) 将 比 简单 的 伪 逆 解 表现 更 好 ， 但 还 
是 不 能 保证 避 开 奇异 。 

因此 很 自然 地 会 去 考虑 在 式 (11. 12) 中 对 goi 
行 选择 ， 以 便 最 小 化 积分 指标 | Hq) de 的 可 能 性 。 


该 指标 定义 在 整个 任务 的 时 间 域 Ce, l] 上 
(比如 随 着 运动 对 可 操作 性 积分 ) 。 不 幸 的 是 ， 这 
个 问题 的 解 (自然 地 会 表示 为 变 分 形式 的 式 子 ) 

可 能 不 存在 ， 并 且 在 任何 情况 下 ， 通 常 都 没有 封 
闭 形式 。 值 得 注意 的 是 ， 使 该 问题 必然 可 解 的 一 
种 方法 是 在 积分 中 加 入 关节 速度 或 加 速度 的 二 
齐 式 。 不 过 ， 这 在 二 阶 运动 学 层面 上 更 容易 实现 
(参见 11.6 45), 


11.5 ” 宛 余 度 求解 的 任务 增 广 法 


另 一 种 宛 余 度 求解 的 方法 是 增 广 任务 向 量 以 便 处 
理 表示 为 约束 的 附加 目标 。 在 本 节 中 ， 将 回顾 用 于 求 
解 一 阶 微分 运动 学 方程 (11.2) 的 基本 的 任务 增 广 
技术 。 
11.5.1 扩展 雅 可 比 和 矩阵 


扩展 雅 可 比 技术 是 由 Baillieul ^ 提出 、 并 在 
后 来 由 Chang'" 再 次 提出 的 。 这 种 方法 在 原始 的 
末端 执行 右 任 务 上 添加 适当 数量 的 函数 约束 ， 从 而 
可 以 在 满足 末端 执行 器 任务 的 无 穷 多 解 中 得 出 确定 
的 二 个 5 

考虑 一 个 优化 的 目标 函数 g(9) ， 
ee J 的 零 

n=l- JJ, 

可 以 验证 ， "s 一 个 给 定 EW ho, WR qu 是 这 样 
一 个 位 形 ， 它 使 函数 g(g) EAR t -k (qu) 之 下 

取得 极 值 ， 则 有 


并 令 N, (g) 
空间 的 矩阵 ， 比 如， 


EE N =0' (11. 33 
ðq uas 1, (09) ) 


如 果 雅 可 比 J, VER, TOS M, SUN, 的 秩 为 N- M。 
因此 ,方程 (11.33) 生成 一 组 独立 的 N-M PAR, 
可 写 为 如 下 向 量 形式 

h(q) =0 
比如 ， 可 以 通过 逐个 求 梯度 9g(g)/9g 与 N-M 个 向 量 
的 标量 积 来 得 到 ， 而 这 N-M 个 向 量 是 了 零 空间 的 一 
个 基底 ， 即 


ha) = (P Gu, com n) 
在 这 一 点 上 ， 条件 (11.33) 意味 着 满足 方程 
e je) 
h(q) 0 
对 于 以 加 和 位 姿 qu 为 起 始点 的 运动 ， 


个 时 刻 都 令 
则 有 


g(q) 取 极 值 来 跟踪 轨迹 1(1) 的 运动 ， 


Bod 
h(q(t)) 0 


两 边 同时 对 时 间 求 导 可 得 


J.(gqo) 。 
ah(q) ZH (11.34) 
BA 0 
aq 
NP, ARAE q 的 矩阵 是 个 方 阵 ， 被 称 为 扩展 雅 


AYE, FEM 
因此 ， 如 果 初 始 位 形 g Egla) 取得 极 值 ， 并 
假设 /不 会 奇异 ， 则 逆 映 射 


ZUM 
0 


的 时 间 积 分 可 生成 使 gs(9g) 取 极 值 的 关节 位 形 ， 从 而 
跟踪 给 定 的 某 端 执行 器 轨迹 i (1) 。 

扩展 雅 可 比方 法 相 比 于 式 (11.13) 形式 的 伪 逆 
法 有 一 个 主要 的 优点 就 是 它 是 循环 的 ( 见 11.7 节 )。 
此 外 ， 通 过 适当 选取 向 量 qo, ME (11.35) 就 可 等 价 
于 解 (11. jaye mg 


11.5.2 增 广 雅 可 比 和 矩阵 


另 一 种 方法 ， 即 所 谓 的 任务 空间 增 广 法 ， 先 引入 
一 个 与 末端 执行 器 任务 一 起 执行 的 约束 任务 。 然 后 ， 
建立 一 个 增 广 雅 可 比 和 矩阵 ， 由 它 的 逆 给 出 搜索 到 的 关 
节 速 度 解 。Sciavicco、 Siciliano!!! 389! 和 Ege- 
land! 分别 独立 提出 了 任务 空间 增 广 的 概念 ， 随 后 
Seraji 又 在 位 形 控制 法 的 架构 中 再 次 提出 这 一 
ma, 

详细 来 说 ， 考 虑 向 量 1, = (t.,…t.,) ， 它 描述 
TA M 维 末端 执行 器 任务 上 一 起 执行 的 附加 任务 。 
虽然 完全 利用 宛 余 度 意味 着 所 考虑 的 附加 任务 要 正好 
和 宛 余 自由 度 一 样 多 ， 即 已 = N-M, 一 般 情况 下 取 
PSN-M, 

关节 空间 坐标 向 量 9 MARES E t, 之 间 的 
关系 ， 可 以 考虑 为 正 向 运动 学 方程 

t, - k.(q) 


(11.35) 


(11.36) 


206 第 2 篇 


机 器 人 结构 


其 中 天 是 一 个 连续 的 非 线性 向 量 函 数 。 
因此 ， 考 虑 如 下 映射 是 有 益 的 


i, -J.(q)4 (11. 37) 
该 映射 可 由 方程 (11.36) 微分 得 到 。 在 式 
(11.37) 中 ,是 约束 任务 速度 向 量 ,， 并且 J.(g) = 
9k./9g Æ P x V 维 的 约束 任务 雅 可 比 和 矩阵 。 
至 此 ， 增 广 任务 向 量 可 以 通过 拼接 末端 执行 器 任 
务 向 量 和 约束 任务 向 量 定义 为 


S ao 
OMS) Mp 
根据 这 一 定义 ， 寻 找 使 取 某 些 期 望 值 的 关节 


位 形 g， 就 意味 着 同时 满足 末端 执行 器 任务 和 约束 
任务 。 


用 上 2 ， 或 在 寻找 更 好 地 调和 两 种 任务 的 位 形 时 
AUSSI, 
考虑 式 (11.2) 和 式 (11.37) 定义 的 任务 ， 通 
过 考虑 它们 的 逆 映 射 可 以 看 到 当 有 
RT) ORS) 101 (11. 39) 
时 ， 两 种 任务 是 冲突 的 ， 因 此 这 是 出 现 算法 性 奇异 的 
条 件 。 另 一 方面 ， 当 有 
RTINRT)=10 
时 ， 因 为 两 个 逆 映 射线 性 无 关 ， 两 种 任务 是 不 冲突 
的 。 有 一 种 任务 不 冲突 的 特殊 情况 是 
RJE) = RT) 
并 且 两 个 映射 相互 正 交 。 
在 算法 性 奇异 点 处 ， 增 广 雅 可 比 矩 阵 不 可 逆 , 但 
可 以 采用 奇异 点 鲁 棒 技术 。 因 为 不 存在 精确 解 ， 会 有 


(11.40) 


这 个 问题 的 解 可 以 通过 在 微分 层面 上 反 求 下 面 的 
WR KARE Bl 
t, -J.(q)4 (11.38) 
其 中 和 矩阵 


被 称 为 增 广 雅 可 比 矩 阵 。 

一 种 约束 任务 向 量 的 特殊 选择 是 上 =h(q)， 其 
P h WIRE 11.5.1 节 中 所 描述 的 那样 定义 ， 这 就 可 
以 使 增 广 雅 可 比 法 包含 了 扩展 雅 可 比 法 。 


11.5.3 算法 性 奇异 


在 跟踪 末端 执行 器 之 外 定义 附加 目标 增加 了 这 
样 的 可 能 性 : 存在 使 增 广 运动 学 问题 奇异 ， 而 单纯 
的 末端 执行 器 任务 运动 学 并 不 奇异 的 位 形 。 这 种 位 
形 因而 被 称 为 算法 性 奇异 。 参 见 速 度 关系 式 
(11.34) 和 式 (11.38), 算法 性 奇异 位 形 使 扩展 牙 
可 比 矩 阵 和 增 广 雅 可 比 和 矩阵 分 别 是 奇异 的 ， 而 J, A 
是 满 秩 的 。 

最 初 的 任务 增 广 宛 余 度 解法 提出 之 后 ，Baillieul 
指出 算法 性 奇异 点 不 是 扩展 雅 可 比方 法 特有 的 问题 ， 
但 扩展 雅 可 比 法 会 造成 约束 任务 与 末端 执行 器 任务 的 
冲突 331。 这 在 简单 情况 下 很 容易 理解 ， 比 如 包 
含 避 障 问题 的 轨迹 跟踪 的 时 候 : 如 果 期 望 轨迹 经 过 一 
个 障碍 ， 那 就 要 么 跟踪 轨迹 ， 要 么 避 开 障碍 ， 两 个 目 
标 不 可 能 同时 实现 。 如 果 两 种 任务 之 间 的 冲突 来 源 有 


重 构 误 差 ， 而 且 这 对 两 种 任务 向 量 都 会 有 影响 。 要 抵 
消 这 个 问题 ， 参 考 文献 [11.44, 45] 考虑 用 加 权 阻 
尼 最 小 二 乘法 来 对 增 广 雅 可 比 矩 阵 求 着 。 另 一 种 不 同 
的 方法 是 所 谓 的 任务 优先 级 道 运动 学 。 


11.5.4 任务 优先 级 


在 任务 优先 级 策略 框架 下 ， 是 通过 给 期 望 任务 分 
配 适当 的 优先 级 ， 然 后 只 在 高 优先 级 任务 的 零 空间 中 
去 满足 低 优先 级 任务 ， 来 处 理 未 端 执行 器 任务 与 约束 
任务 之 间 的 冲突 04%91 。 典 型 情况 下 ,未 端 执行 器 
任务 被 认为 是 主要 任务 , 虽然 有 时 它 是 次 要 任 
gUB] 该 方法 的 思想 是 当 精 确 解 不 存在 时 ， 重 构 
误差 只 会 影响 低 优先 级 的 任务 。 
参见 解 (11. 12) ， 任 务 优先 级 方法 计算 出 适当 
的 do, URM P RARES i.。 值 得 注意 的 是 ， 
将 名 投影 到 了 的 零 空间 保证 了 约束 任务 比 未 端 执行 
器 任务 的 优先 级 低 ， 因 为 投影 结果 是 一 个 零 空 间 
xi gg 481 5 
当 次 要 任务 i 与 主要 任务 P 正 交 (〈 即 满足 方程 
(11.40)) 时 ,关节 速度 
qo -Ji(4) t. (11.41) 
可 以 很 容易 地 解决 问题 ， 而 且 主 要 任务 速度 映射 式 
(11.2) 的 零 空间 速度 也 有 了 ( 即 不 需要 N, 的 投影 
项 了 ) 。 不 过 ， 通 常 两 类 任务 可 能 不 冲突 但 也 不 是 正 
交 的 , 或 者 有 冲突 ， 不 存在 同时 实现 i 和 i 的 关节 
速度 解 。 方 法 与 两 种 任务 所 定义 的 优先 顺序 相关 ， 一 


一 个 清晰 的 含义 ， 那 么 算法 性 奇异 就 有 可 能 根据 具体 
情况 ， 通 过 机 敏 地 定制 约束 任务 来 避免 〈 例 如， 参 


种 合理 的 选择 是 保证 精确 跟踪 主要 任务 速度 的 同时 ， 


考 文献 [11.23] )。 在 更 一 般 的 情况 下 ， 一 些 分 析 工 
具 可 能 在 寻找 算法 性 奇异 和 指导 约束 函数 的 选取 时 有 


最 小 化 约束 任务 速度 的 重 构 误 差 i.- J.g， 因 此 


2A h [11.49] 
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4, =( J.-F.) "Ct, 241). (01.42) 
Ea, WME BI A> zx HR] ERA ALT Ie EY JE, 28 AB 
阵 ， 所 以 式 (11.12) 和 式 (11.42). 的 解 可 以 简 
化 为 "多 
q =Tt +[J -JJ)]' -JJ E) 
(11.43) 
可 以 验证 ， 算 法 性 奇异 的 问题 还 是 存在 。 实 际 
上 ， 当 条 件 (11.39) 成 立时 ， 对 于 满 秩 的 了 和 J.， 
EJ G-J) 也 会 降 秩 。 不 过 ， 与 任务 空间 增 
广 法 不 同 ， 只 要 主要 任务 雅 可 比 和 矩阵 满 秩 就 可 以 得 到 
正确 的 主要 任务 解 。 另 一 方面 ， 在 算法 性 奇异 点 之 
外 ， 任 务 优 先 级 方法 给 出 的 解 和 任务 空间 增 广 法 是 一 
样 的 。 而 接近 算法 性 奇异 点 时 ， 解 的 品质 变 坏 ， 可 能 
造成 很 大 的 关节 速度 。 这 个 问题 可 以 通过 考虑 有 关 算 
MAIR, JAR ELE 24 B I (ELTE AR IV 24 IB, 
在 一 定 程 度 上 解决 入“ 。 这 样 所 得 到 的 关节 速度 是 
有 限 大 小 的 ， 前 提 是 必须 保证 零 空 间 分 量 的 连续 性 。 
另 一 种 方法 是 放宽 次 要 任务 速度 重 构 约束 的 最 低 
限度 ， 只 去 跟踪 式 (11.41) 中 不 与 主要 任务 冲突 的 
Ba 


q -J +U-S sit. (11.44) 

这 种 解 的 一 个 直观 依据 可 以 这 样 得 到 : Pa! 
和 半分 别 用 于 求解 各 自任 务 速 度 的 关节 速度 ， 然 后 
把 相应 于 约束 任务 〈 次 要 的 ) 的 关节 速度 投影 到 
的 零 空 间 ， 以 消除 将 引起 与 末端 执行 器 任务 (主要 
的 ) 冲突 的 部 分 ， 最 后 把 它 和 相应 于 末端 执行 器 任 
务 的 关节 速度 释 加 。 其 结果 , f (11.44) 有 一 个 
优良 特性 ， 即 算法 性 奇异 点 与 J 的 奇异 点 是 解 
TRI, 

可 以 推断 ， 解 (11.44) 的 约束 任务 重 构 误 差 
比 解 (11.43). 的 更 大 。 这 是 在 跟踪 有 冲突 的 任务 
时 ， 使 给 出 的 关节 速度 轨迹 光滑 可 行 的 代价 。 不 过 ， 
对 于 可 以 在 算法 性 奇异 点 之 外 修复 次 要 任务 跟踪 误 
差 的 CLIK 应 用 , fü (11.44) 更 好 。 在 这 种 情况 
下 有 


q = Jio, * Qr -JU.)J.o, 


其 中 
w,=t +K(t-k,(q)) 
e, - i +K(t,-k.(q)) 
11.6 二 阶 元 余 度 求解 


在 加 速度 级 求解 元 余 度 可 以 考虑 机 械 臂 运 动 过程 


的 动力 学 性 能 。 而 且 ， 得 到 的 加 速度 曲线 可 以 直接 作 
为 任务 空间 动力 学 控制 器 的 参考 信号 (与 相应 的 位 
置 和 速度 信号 一 起 ) 。 但 另 一 方面 ， 二 阶 宛 余 度 求解 
算法 在 计算 量 方面 总 是 要 求 更 高 。 

最 简单 的 加 速度 级 算法 是 式 (11.15) 中 提出 
的 ， 即 给 出 实现 任务 约束 (11.8) 的 最 小 范 数 解 。 
与 速度 级 伪 逆 解 一 样 ， 这 种 局 部 优化 解 生成 的 关节 
运动 无 法 在 机 械 辟 整个 的 运动 过 程 中 使 加 速度 全 局 
最 小 。 不 过 值得 注意 的 是 ,使 用 式 (11.15) 可 在 
Us, n] 内 最 小 化 积分 指标 9"Gdt ， 前 提 是 满足 适 


当 的 边界 条 件 呈 2521， 比如 在 端点 自由 的 情况 下 
(4, 和 i 时 刻 的 关节 位 置 和 速度 都 没有 指定 )， 需 要 满 
足 的 边界 条 件 可 以 分 开 ， 并 表示 为 
qG) =J iG) t=h,t 
因此 ， 虽 然 解 (11.15) 表面 上 简单 而 优雅 ， 实 
际 上 最 小 化 上 述 积分 代价 需要 求解 一 个 两 点 边界 值 问 
题 (TPBVP) ， 这 是 个 运算 量 很 大 的 过 程 ， 对 于 实时 
运动 学 控制 是 不 可 行 的 。 不 过 ， 对 于 工业 调试 中 的 离 
线 宛 余 度 求解 ， 却 是 非常 令 人 满意 的 。 
通过 考虑 全 部 的 二 阶 解 (11.14) ， 可 以 更 灵活 
地 选择 〈 局 部 的 或 全 局 的 ) 性 能 指标 。 将 机 械 臂 动 
力学 模型 表示 为 
T=H(q)q *c(q,q) +T(q) (11.45) 
式 中 ，z 为 驱动 力矩 向 量 ; H 为 机 械 辟 惯性 矩阵 ; c 
为 离心 力 / 哥 氏 力 项 ; Ti 为 重力 项 。 取 式 (11.14) 的 
零 空间 加 速度 为 


do = -LHO-JJ)]'* 


(11. 46) 
其 中 


T-HJ' (Ë -J4) sc«t 
ix uf URB Ec 7) (63K 21] 7] jp YE Cm Toe), HK 
种 特殊 的 元 余 度 求解 方 法 对 于 短 时间 的 任务 表现 很 
好 ， 但 在 长 时 间 的 运行 中 可 能 会 不 稳定 (更 准确 地 
说 ， 是 关节 力矩 会 非常 大 ) ， 本 质 原因 是 零 空 间 关 
节 速 度 的 增 大 。 还 要 注意 , 式 (11.46) 中 的 和 矩阵 积 
H(I-JJ)) 是 不 满 秩 的 ， 因 此 它 的 伪 逆 必须 通过 
个 SVD 过 程 来 计算 。 整 体 上 最 小 化 关节 力矩 也 是 有 
可 能 的 路 漠 ， 这 种 解 显然 避 开 了 不 稳定 问题 ,但 又 
需要 求解 一 个 TPBVP。 
另 一 种 有 趣 的 逆 解 如 下 
=al -44) *(0-JLJOH c 
(11.47) 
从 使 用 加 权 伪 逆 的 角度 来 看 ， 它 是 通 解 (11.14) 的 
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轻微 改动 。 详 细 地 说 ， 几 /是 惯性 加 权 的 任务 雅 可 比 
伪 逆 ， 惯 性 矩阵 满 秩 时 可 以 表示 为 下 式 
Jin HR (SA'S) 
解 (11.47) 最 小 化 了 
上 ED) 人 
即 机 械 辟 动能 在 Ln, n] EAM BUR, XD 
要 用 到 正确 的 边界 条 件 ， 比 如 端点 自由 时 有 


4) =J' yt (7) 
循环 性 


基于 微分 运动 学 的 元 余 度 求解 算法 的 共有 缺点 是 
缺少 循环 性 〈 也 称 为 可 重复 性 ) : 通常 ， 一 个 循环 的 
任务 空间 轨迹 对 应 的 关节 空间 轨迹 本 身 却 不 是 循环 的 
( 即 关节 的 最 终 位 置 和 初始 位 置 不 一 致 )。 这 种 现象 
显然 是 不 希望 的 ， 因 为 这 基本 上 意味 着 在 反复 重复 周 
期 性 任务 时 ， 机 械 臂 行为 是 不 可 预知 的 。 

对 于 一 类 特殊 的 元 余 度 解法 ， 存 在 一 个 循环 性 能 
否 满 足 的 数学 条 件 “” 。 特 别 地 ， 考 虑 如 下 形式 的 
任意 解法 


LT 


11.7 


q =G, (pt (11.48) 
IPF, G, ES IEn HEE J, 的 任意 一 种 广义 道 ， 
ERE JGJ, =J, 的 一 个 NxM ERE ( 式 (11.13) 
中 的 伪 逆 矩阵 开 就 是 一 种 特殊 的 广义 逆 )。 设 给 定 任 
Bta) 在 任务 空间 的 一 个 简单 连通 域 中 描述 了 一 个 
循环 轨迹 ， JF gila) 表示 G, WH i Hl, HK 
(11.48) 生成 循环 的 关节 轨迹 的 一 个 充 要 条 件 是 ， 
分 布 


AG,(q) =span|gu (4) 8u (@) | 
是 对 合 的 ( 即 ， 它 对 于 李 (Lie) 括号 操作 是 封闭 
的 ) 。 

需要 强调 的 是 ，AG, 的 对 合 性 是 一 个 强 条 件 ， 
因为 必须 在 所 有 位 形 都 满足 它 。 这 意味 着 多 数 广义 
逆 都 不 是 循环 的 。 还 要 注意 ， 上 述 对 于 循环 性 的 条 
件 不 仅 取决 于 选取 的 广义 逆 ( 即 伪 逆 、 加 权 伪 北 
等 )， 还 取决 于 J 的 形式 ， 它 又 与 机 械 臂 的 机 械 结 
构 相 关 。 这 意味 着 循环 性 必须 根据 个 体 情况 分 别 
建立 。 

至 于 非 (11.48) 类 的 宛 余 度 求 解法 ， 即 通 解 
(11.12) 衍生 的 那些 解法 ， 通 常 都 不 是 循环 的 。 尤 
其 是 当局 部 优化 法 用 于 求解 宛 余 度 时 ， 比 如 式 
(11. 32) ， 更 是 如 此 。 值 得 注意 的 是 ， 扩 展 雅 可 比 法 
是 一 个 例外 ， 它 总 是 循环 的 。 


11.8 ETRIE 


研究 运动 学 宛 余 时 产生 的 一 个 自然 问题 就 是 ; 
当 关 节 数 (而 且 因此 宛 余 度数 ) 远大 于 任务 空间 
维 数 时 会 怎样 ， 最 终 趋 于 无 穷 时 会 如 何 呢 ?自然 
界 存在 具有 许多 关节 的 串联 刚性 连 杆 系统 的 例子 
(比如 蛇 、 哺 乳 动物 和 鱼 的 脊椎 ) ， 这 种 生物 学 上 
的 存在 性 证 据 启发 和 吸引 了 机 器 人 研究 者 和 设计 
者 许多 年 。 在 这 种 兴趣 之 下 发 展 出 了 几 种 特殊 类 
型 的 元 余 度 机 械 臂 ， 一 起 被 称 为 超 宛 余 度 机 械 辟 。 
本 节 对 这 个 令 人 感 兴趣 的 领域 的 基本 问题 和 现状 
进行 综述 。 

通常 如 果 一 个 机 械 辟 可 控 的 位 形 (关节 ) 空间 
自由 度 ， 比 得 上 或 超过 了 它 的 任务 空间 自由 度 ， 就 
被 认为 是 超 宛 余 的 。 ( 因此， 七 或 八 自 由 度 的 空间 
刚性 杆 机 械 臂 一般 不 被 认为 是 超 宛 余 的 ,) EIR 
机 械 辟 提高 了 利用 其 额外 的 关节 进行 手臂 抓 持 / 操 
作 ， 和 在 障碍 密集 区 域 机 动 的 潜力 。 因 此 预期 的 
应 用 包括 拥挤 环境 下 的 工作 (灾难 救援 、 医 疗 应 
用 等 ) 。 

就 像 所 观察 到 的 那样 ，( 任何) 宛 余 度 的 增加 都 
将 增加 新 的 基本 能 力 ( 自 运动 、 子 任务 执行 能 力 )， 
所 以 直觉 上 认为 增加 大 量 的 自由 度 有 可 能 继续 增加 新 
的 和 复杂 的 行为 。 不 过 ， 详 细 观 察 发 现 ， 许多 引起 人 
兴趣 的 生物 超 宛 余 系 统 实际 上 只 做 相对 有 限 的 运动 ， 
由 非常 简单 的 算法 控制 。 例 如 ，( 生 物 ) Wen AEA 
非常 多 的 关节 ， 然 而 蛇 的 运动 是 典型 的 由 近似 正弦 曲 
线 限定 的 运动 ， 由 简单 的 参数 ( 幅度 ， 频 率 ) 决定 。 
因此 ,设计 者 和 算法 开发 人 员 找 到 了 许多 关键 性 的 简 
化 ， 并 用 于 了 超 宛 余 机 械 臂 的 开发 ， 如 11.8.3 节 的 
讨论 。 

在 便 件 开发 方面 ， 该 领域 发 展 出 了 两 个 主要 方 
向 : SAEED AS MEAT LTT AS CASE Bh A EE BE 
体 机 械 臂 。 本 节 下 面 的 两 个 单元 概述 了 这 两 个 方向 的 
历史 和 现状 ， 随 后 讨论 了 超 宛 余 机 器 人 系统 所 需要 的 
和 所 发 展 出 的 独特 分 析 技 术 。 总 之 ， 关 键 的 问题 是 以 
这 样 或 那样 的 形式 处 理 复杂 性 。 


11.8.1 刚性 杆 超 宛 余 设 计 


按照 从 传统 的 串联 刚性 连 杆 机 械 臂 (ICR RAE 
TUR) 往 上 进化 的 逻辑 ， 这 一 类 超 宛 余 度 机 械 臂 
可 能 是 最 自然 的 。 这 种 机 器 人 的 设计 特色 是 有 超级 多 
的 刚性 杆 结构 的 关节 (通常 是 串联 的 ) AKLA 
设备 一 个 很 好 的 早期 实例 是 JPL EE BL d ALIUS, 


= 
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其 特色 是 模块 化 设计 了 12 个 自由 度 。 
设计 方面 的 一 般 趋 势 是 减少 连 杆 的 尺寸 ， 以 便 把 t 


机 器 人 结构 像 生物 疹 椎 那样 组 装 起 来 。 这 种 方法 从 概 
念 上 来 说 能 够 开发 出 具有 非常 高 自由 度 的 机 器 人 ， 比 
如 加 州 理工 开发 的 三 十 自由 度 的 平面 机 械 辟 "”， 
它 可 能 一 直 是 最 著名 的 超 匈 余 度 机 器 人 。 十 七 自由 度 
Plax AULA 11. 4。 


图 11.5 NASA 专用 灵巧 机 械 手 (SPDM ) 
(感谢 MDA Federal 公司 提供 照片 ) 


发 的 超 宛 余 度 主动 索 机 构 (ACM: Active Cord Mecha- 
nism) ( 见 图 11.6) 机 器 人 系列 。 


图 11.4 十 七 自由 度 机 器 人 (感谢 美国 机 器 人 研究 公司 
(Robotics Research Corporation ) 提供 照片 ) 


图 11.6 主动 索 机 构 (ACM: Active Cord Mechanism ) 


请 注意 ， 多 种 不 同类 型 的 非 传统 刚性 连 杆 机 器 人 (感谢 S. Hirose 提供 照片 ) 
系统 都 可 以 归 为 此 类 超 元 余 系 统 。 新 型 象 鼻 是 以 特殊 
的 三 十 二 自由 度 痊 柱 为 基础 设计 的 路。 一 些 双 臂 / 这 么 多 年 有 许多 其 他 的 蛇 形 机 器 人 设计 被 提出 来 
MT ABEL), HIS NASA 的 专用 灵巧 机 械 手 了， 而 且 这 一 领域 依旧 是 高 度 活 里 的 。 
( SPDM: Special- Purpose Dextrous Manipulator ) (eo 刚性 杆 超 元 余 设计 概念 上 的 关键 性 优点 在 于 继承 
v 兄 图 11 5) ， 可 以 归 为 这 一 类 超 元 祭 机 械 背 ， 而 旦 了 与 之 类 似 的 传统 工业 机 械 幅 的 运动 学 。 因 此 ， 所 有 


人 形 机 器 人 领域 的 研究 者 在 理论 和 硬件 上 都 在 这 一 领 ”的 传统 建筑 技术 〈 比 如 基于 D-H 法 的 前 站 运动 学 全 
E 模 和 机 器 人 雅 可 比 推导 都 还 适用 。 因 此 ， 理 论 上 

此 关机 器 人 中 另 种 竺 别 重要 的 竺 呈 类 理 是 机 器 夺 有 本 章 之 前 讨论 的 方法 前 可 以 直接 应 用 于 此 类 超 克 
Ade, RM SIF AH TE ni. ROU A (BURSTS RIES or 利生 全 
tose 1， 他 分 析 了 生物) 蛇 的 运动 ， 并 把 所 理解 。 COTAR. Dal, BOW ERA CHEF 
到 的 知识 用 于 一 系列 创新 性 的 蛇 形 机 器 人 的 设计 和 控 LOI TOIHTPOE) , TRUE PST ERLA 


A ne 
制 。 其 中 尤其 令 人 感 兴趣 的 是 Hirose 的 研究 组 团队 开 “， 致 ， 却 没有 继承 这 些 特殊 的 优点 。 
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11.8.2 ”连续 体 机 器 人 设计 


连续 体 机 械 臂 这 一 术语 首次 出 现在 参考 文献 
[11.62] F, 它 把 超 元 余 机 器 人 概念 推 向 了 极致 。 
换 名 话说， 概念 上 这 种 机 器 人 达到 了 状 椎 结构 的 极 
限 ， 关 节 数 趋 于 无 穷 ， 而 连 杆 长 度 趋 于 零 。 当 这 种 概 
念 最 初 看 上 去 是 空想 的 、 复 杂 并 且 不 可 能 实现 的 时 
修 ， 其 极限 形式 (光滑 的 连续 曲线 外 形 ， 可 以 在 闪 
椎 的 任何 一 点 弯曲 ) 在 硬件 上 却 相 当 容 易 实现 。 从 
20 世纪 60 年 代 早期 以 来 ， 提 出 了 很 多 种 连续 体 设 
PPS) 。 关 键 的 设计 问题 在 于 怎样 驱动 (弯曲 以 
及 可 能 的 拉 伸 和 压缩 ) 这 样 的 脊椎 。 出 现 了 两 种 基 
本 的 设计 方法 : 中 体外 驱动 ， 驱 动 絮 分开 在 疹 椎 结构 
之 外 与 和 1。@@ 内 驱动 ， 驱 动 器 表现 为 脊椎 结构 的 一 
个 基本 部 分 ， 参 见 参考 文献 [11.65]. KEIR Bh BIE 
明 是 一 种 流行 的 和 通常 很 成 功 的 内 驱动 连续 体 设 
计 咏 ”的 。 人 工 肌 肉 技术 ， 特 别 是 McKibben 肌肉 ， 
也 被 证 明 对 于 内 驱动 硬件 实现 是 有 效 玉 “1 OctArm 
连续 体 机 械 臂 见 图 11.7。 


图 11.7 OctArm 连续 体 机 械 辟 (感谢 I Walker 提供 照片 ) 


目前 ， 英 国 的 OCR 机 器 人 公司 制造 和 销售 了 一 
组 商业 上 取得 了 成 功 的 外 驱动 连续 体 机 械 臂 ""。 
图 11. 8 为 其 中 一 种 。 

就 在 连续 体 机 械 辟 被 看 成 是 超 匈 余 度 的 极限 形 
态 的 时 候 ， 它 迅速 地 描绘 出 了 本 质 上 全 新 的 一 类 机 
PU), ERNE AE, BD EME LE, UE 
穷 多 自由 度 为 特色 。 因 此 ， 用 于 刚性 连 杆 链 建 模 的 
机 器 人 学 传统 方法 就 不 再 适用 了 。 此 外 ， 显 然 实 际 
上 也 无 法 驱动 数量 无 穷 多 的 自由 度 。 连 续 体 机 械 臂 
硬件 的 特点 通常 是 拥有 有 限 数量 的 驱动 器 ， 只 在 事 
先 设 定 的 一 系列 固定 位 置 上 施加 驱动 力 / 力 和 矩 。 连 续 
体 机 器 人 因此 本 质 上 既是 超 宛 余 的 又 是 和 欠 驱 动 的 ， 
这 就 造成 了 分 析 中 很 重要 的 复杂 性 。 不 过 ， 相 关 研 


图 11.8 连续 体 机 械 辟 (感谢 OC Robotics 公司 提供 照片 ) 


究 已 经 取得 了 重大 成 果 ， 连 续 体 运动 学 分 析 得 出 的 
知识 无 论 是 对 连续 体 还 是 对 非 连续 体 超 元 余 机 械 臂 ， 
都 已 经 有 了 有 益 的 应 用 ， 下 面 一 个 单元 将 对 此 进行 


讨论 。 
11.8.3 ETRIE EIR 


WA, ENR 1 E M ENE hs EUR E A HE 
WERA, FRE, E ER UL EK E REFF 
超 宛 余 系统 运动 规划 的 关键 性 理论 基础 。 正 如 前 面 所 
提 到 的 ， 理 论 上 离散 连 杆 超 宛 余 机 械 臂 的 建 模 可 以 用 
传统 的 机 械 臂 建 模 方法 来 进行 ， 而 且 其 规划 也 可 以 基 
于 这 些 方法 。 不 过 ， 人 们 很 快 就 发 现 这 些 方法 的 计算 
复杂 性 使 它们 难以 实现 ， 而 且 相应 的 模型 很 难得 到 。 
另 一 种 可 供 选 择 〈 而 且 实践 中 更 为 成 功 ) 的 策略 是 
采用 基于 连续 体 机 械 臂 运动 学 的 方法 。 下 面 ， 概 述 一 
下 连续 体 机 械 辟 运动 学 的 最 新 发 展 情况 。 然 后 讨论 现 
有 的 离散 连 杆 和 连续 体 模型 是 怎样 提高 每 种 超 见 余 系 
统 的 运动 规划 的 性 能 的 。 

连续 体系 统 没 有 明显 的 连 杆 ， 而 标准 的 机 器 人 机 
械 臂 建 模 方法 基于 有 限 数 量 的 坐标 系 (每 个 连 杆 固 
接 一 个 ) ， 因 此 不 适 于 它们 的 建 模 。 作 为 替代 ， 自 然 
NTE EM AE, MIK s 为 参数 的 坐标 
系 ， 通 过 它 来 进行 连续 体 运 动 学 建 模 。 痊 椎 在 点 s 处 
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的 局 部 运动 用 局 部 坐标 系 来 建 模 。 这 种 方法 使 得 前 向 
运动 学 的 计算 量 ， 以 及 连续 体 雅 可 比 的 建立 ， 都 和 刚 
ER ASA 。 

VE EPER HE bj 8 B9 E IK E A A h OK 
TENTE, 一 种 流行 的 方法 是 著名 的 Serret- Frenet A 
标 系 ，"“] ， 它 由 下 式 来 表示 疹 椎 

dr 
ds 
dn 
ds 
dh. 
ds 

上 面 的 坐标 中 ， 坐 标 原点 由 x 给 定 ， 曲 线 的 单位 
切线 为 1= dx/ds， 构 成 一 个 坐标 轴 。 其 他 坐标 轴 定 义 
为 它 的 法 线 (t-n) =0 和 次 法 线 b=txn。 曲 率 k 和 
挠 率 z 决 定 曲线 的 形状 。Serret- Frenet 坐标 系 的 坐标 轴 
给 出 了 局 部 运动 的 一 种 直观 描述 : 两 维 可 能 的 弯曲 ， 
对 应 于 绕 法 线 和 次 法 线 轴 的 旋转 ， 以 及 一 个 维度 的 1 
长 /压缩 (一 些 连 续 体 机 器 人 已 有 并 可 控 ) ， 对 应 于 
沿 着 切线 轴 的 平移 。Serret- Frenet 模型 的 优点 在 于 它 
是 一 种 被 广泛 认可 了 的 连续 空间 曲线 建 模 方法 。 连 续 
体 机 器 人 文献 中 的 另 一 种 坐标 表示 法 选择 的 坐标 轴 
与 特定 硬件 的 受 控 运 动 轴 一 致 入 “9 。 不 论 用 哪 种 方 
式 确 定 了 坐标 系 ， 关 键 问 题 都 是 怎样 利用 所 得 到 的 
模型 来 规划 超 宛 余 机 器 人 的 运动 。 一 个 基本 的 问题 
是 连续 体 运动 学 模型 的 基本 形式 是 以 有 无 穷 多 自由 
度 为 特征 的 (这 是 任意 空间 曲线 建 模 所 必需 的 )。 
然而 ， 超 宛 余 机 器 人 (离散 关节 或 连续 体 ) 能 够 仅 
以 有 限 自由 度 的 方式 来 控制 ， 因 而 可 以 使 用 物理 解 
的 一 个 简化 集 。 因 此 ， 超 宛 余 机 械 臂 方向 上 的 研究 
集中 在 了 怎样 使 连续 体 模型 能 最 好 地 描述 机 器 人 硬 
tt E, 

超 元 余 臂 运动 规划 方面 最 初 的 主要 突破 是 在 一 系 
列 里 程 碑 式 的 论文 下 中 做 出 的 ， 即 引入 了 连续 
体 运 动 学 ， 并 将 其 用 于 对 刚性 杆 超 匈 余 系 统 进行 近 
AWS  。 基 本 的 思路 是 使 用 一 条 (理论 上 的 ) 曲线 
来 对 超 宛 余 机 器 人 的 疹 椎 实体 进行 建 模 。 先 进行 运动 
规划 ， 得 出 一 条 曲线 ， 然 后 让 (离散 的 ) 机 器 人 痊 
椎 去 拟 合 所 产生 的 (连续 的 ) 曲线 。 这 种 方法 被 证 


© 
rH 


kn 
= -kt +Tb® 


-Tn 


内 ) 的 使 用 ,该 方法 导出 了 超 匈 余 机 械 臂 的 元 余 度 
解法 。 这 个 有 影响 的 概念 可 以 看 成 是 建立 通用 模型 ， 
Jf (通过 模 态 选择 和 曲线 拟 合 ) 让 模型 顺应 硬件 的 
一 种 自 顶 向 下 的 方法 。 

更 新 一 些 的 研究 集中 在 与 前 文 对 偶 的 思路 上 ， 利 
用 特定 类 型 的 连续 体 机 器 脊椎 硬件 所 具有 的 物理 约 
束 来 构建 连续 体 运动 学 。 这 可 以 看 成 是 自 底 向 上 的 方 
法 ， 关 注 特定 的 硬件 类 型 ， 以 硬件 的 高 效 建 模 为 主要 
目标 ， 避 免 运动 规划 时 进行 近似 。 参 考 文献 [11.65, 
68] 给 出 了 这 种 方法 的 实例 ， 在 该 方法 中 ， 施 加 在 
一 般 连 续 体 运动 学 模型 上 的 关键 性 约束 来 源 于 这 样 的 
观察 ， 即 许多 连续 体 的 硬件 实体 都 由 有 限 个 常数 曲率 
的 分 段 组 成 的 。( 这 自然 是 因为 必须 用 有 限 数 量 的 输 
入 力 / 力 矩 作用 于 坚硬 的 连续 体 疹 椎 。) 值得 注意 的 
是 ， 参 考 文献 [11.65] 所 得 出 的 常 曲率 模型 可 以 被 
看 成 是 参考 文献 [11.69] 所 述 的 一 般 性 模 态 方法 的 
一 种 特定 情况 。 

上 述 方法 参考 文献 [11.65] 包含 一 些 转换 ， 
即 通过 节 空 间 来 转换 任务 空间 和 驱动 器 空间 之 间 的 
映射 。 这 种 转换 的 一 个 关键 部 分 ， 是 用 传统 的 (XH 
论 上 的 ) 刚体 模型 来 对 机 械 辟 的 每 一 节 建 模 。 因 此 
刚体 运动 学 已 被 证 实 是 连续 体 机 械 臂 元 余 度 求解 的 
关键 ， 同 样 ， 连 续 体 运动 学 是 刚性 连 杆 超 宛 余 手 臂 
的 宛 余 度 求解 的 一 个 关键 部 分 。 最 终 ， 将 建立 一 系 
列 雅 可 比 和 矩阵 。 区 别 是 连续 体 雅 可 比 矩 阵 是 描述 节 
的 形态 的 局 部 意义 变量 ( 挠 曲 角 、 曲 率 和 拉 伸 ) ， 
或 决定 这 些 变量 值 的 驱动 器 的 直接 变量 的 本 数 。 
设 有 连续 体 的 雅 可 比 矩 阵 ， 则 宛 余 度 通常 可 以 
解 为 


I = 用 二 + 及 75) 
求解 方法 与 本 章 前 面 已 经 讨论 了 的 ， 传 统 元 余 度 
机 械 辟 所 用 的 方法 一 样 (相应 的 优点 和 问题 也 是 一 
样 的 ) 。 


结论 与 扩展 阅读 


运动 学 郊 余 机 器 人 的 大 量 研究 已 经 有 二 十 多 年 
了 ， 现 在 仍然 非常 活跃 。 这 方面 的 文章 数量 因此 非常 
巨大 。 下 面 引用 的 少量 文章 只 不 过 是 对 之 前 已 经 引用 


11.9 


明 是 非常 有 效 的 ， 而 且 相 关 的 研究 为 本 领域 引入 了 一 
些 关 键 性 的 理论 概念 。 尤 其 是 模 态 法 "(将 允许 
解 的 集合 限制 在 由 模 态 的 简单 线性 组 合生 产 的 形态 


AYE: 此 公式 中 的 T 应 为 r， 原 文 有 误 。 


了 的 基本 文献 的 一 个 小 小 的 补充 ， 绝对 不 是 详尽 无 


遗 的 。 
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机 器 人 结构 


运动 学 元 余 机 械 臂 的 机 械 设计 已 有 很 多 文章 进 
行 了 研究 ， 比 如 可 参见 参考 文献 [1170-74]. FF 
别 推荐 的 是 ， 参 考 文献 [11.75] 首次 指出 了 类 人 
手臂 的 机 械 臂 相 比 于 传统 的 六 自由 度 机 器 人 所 具有 的 
优越 性 。 人 参考 文 献 [11.76, 77] 研究 了 通过 手臂 
形态 的 重新 配置 确保 在 整个 工作 空间 中 的 最 大 灵活 
性 的 问题 。 

参考 文献 [11.78] 全 面 分 析 了 和 宛 余 机 械 臂 的 逆 
运动 学 问题 。 特 别 推荐 的 是 ， 参 考 文献 [11.79] 分 
析 了 自 运 动 的 几何 结构 。 

参考 文献 [11.9, 21, 80] 提出 了 在 不 同性 质 
的 末端 执行 器 任务 中 ， 能 保证 避 开 奇异 的 加 权 阻 尼 最 
小 二 乘 解 。 

除了 避 开 奇异 ， 宛 余 度 还 被 用 于 实现 壁 障 习 7”“ ”2 、 
最 小 化 关节 的 弹性 效应 凸 呈 、 容 错 呈 的 、 减 小 冲击 
JUSS, VB AH TG PETER BU Sc [EU 15087 
参考 文献 [11.88] 提出 了 一 种 完全 不 同 的 匈 余 度 机 
器 人 壁 障 方法 。 

参考 文献 [11.89] 综述 了 宛 余 度 求解 的 局 部 优 
化 法 。 参 考 文献 [11.90] 提出 了 一 种 计算 效率 不 一 
样 的 局 部 优化 宛 余 度 求解 方法 。 参 考 文献 [11.91] 
提出 了 一 种 基于 介 于 局 部 和 全 局 优化 之 间 的 某 种 中 间 
性 质 的 元 余 度 求解 方法 。 二 阶 元 余 度 求解 的 其 他 方法 
也 有 讨论 ， 比 如 参考 文献 [11.92] 中 所 述 。 同 样 值 
得 引用 的 还 有 关于 动态 相 容 广义 逆 的 ”1。 

循环 性 问题 由 参考 文献 [11.94] 首次 指出 ， 并 
18 8 T uE— 2b B EZECH 99. 参考 文 献 [11.97， 
98] 阐述 了 受到 非 完 整 约束 的 小 车 -机 械 臂 系统 的 宛 
余 度 求解 的 一 般 形式 。 
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ARTETA FER LI (TR BK LE IF HK BL de A) 
的 运动 学 与 动力 学 。 与 传统 的 串联 机 器 人 不 同 ， 并 
联机 峰 人 的 运动 结构 中 包含 闭 链 ， 因 此 二 者 的 分 析 
大 不 相同 。 本 章 将 介绍 并 联机 器 人 分 析 中 的 基本 公 
式 和 技巧 。 


12.1 EN HH 215 
12.2 并 联机 构 的 型 综合 PP 216 
12.83 运动 学 217 
12.3.1 道 运动 学 M 217 
12.3.2 正和 运动 学 eee MM MM 217 


12.1 定义 


闭环 运动 链 是 包含 了 至 少 1 个 由 连 杆 和 运动 副 组 
成 的 闭环 的 运动 链 ， 而 复杂 的 闭环 运动 链 是 指 除了 基 
座 以 外 的 某 个 连 杆 的 连接 度 大 于 等 于 3， 也 就 是 说 ， 
该 连 杆 通过 运动 副 同 时 与 至 少 3 个 连 杆 相连 。 并 联机 
械 手 可 被 定义 为 包含 基 座 以 及 1 个 具有 nn 个 自由 度 的 
机 械 手 的 闭 链 机 构 ， 且 与 基 座 相连 的 独立 支 链 数 不 小 
d 25 

1928 年 由 Gwinneu ^ FAIR PE RAE AY 
专利 便 是 1 个 并 联机 器 人 的 例子 。1947 年 Gough ^? 
设计 了 一 种 并 联机 构 (ILE 12.1) 并 提出 了 调整 其 
动 平台 的 位 置 和 方向 的 基本 原理 以 实现 检测 轮胎 磨损 
的 目的 。1955 年 Gough 制造 了 样机 ， 动 平台 为 六 边 
形 ， 每 个 顶点 通过 球 铵 与 1 条 支 链 相连 ， 而 支 链 的 另 

端 通过 虎 克 铵 与 静 平台 相连 。 支 链 中 的 线性 驱动 器 
可 以 改变 支 链 的 长 度 ， 因 此 该 样机 是 由 6 个 线性 驱动 
器 驱动 的 并 联机 构 。 

1965 年 Stewart 3 建议 将 此 机 构 用 于 飞行 模拟 
器 ， 因 此 Gough 平台 有 时 亦 被 称 作 Stewart 平台 。 近 
来 此 机 构 又 被 Kappel ££ UH fE3s 2 ECE 6/7, 
今天 Gough 平台 已 成 为 飞行 模拟 器 的 首选 。 这 项 应 用 
也 说 明了 并 联机 构 的 一 个 明显 优点 ， 即 承载 能 力 强 。 
对 六 个 转动 自由 度 串 联 组 成 的 工业 机 械 手 来 说 ， 负 载 


12.4 速度 和 精度 分 析 M M MMMMMMHMMHMHH HI 
12.5 奇异 分 析 eee MMMHMHMMHMMMHHHHHMHHMHeHHeHMHMHR 
12.5.1 通用 公式 
12.5.2 并联 奇异 分 析 
12.6 TIME BAM e M M MA 
12.7. BEJZA nn 
12.8 动力 学 分 析 
12.9 
12. 10 


图 12.1 Gough 平台 (1947) 


与 自重 的 比例 基本 上 小 于 0.15， 而 对 并 联机 构 ， 


此 


比例 可 大 于 10, Gough 平台 的 男 一 个 优点 是 定位 精度 
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很 高 ， 因 为 每 条 支 链 本 质 上 只 受到 拉力 或 压力 而 几乎 
不 产生 弯曲 ， 所 以 变形 很 小 。 此 外 机 构 内 部 传感器 误 
差 (Gough 平台 支 链 长 度 的 测量 误差 ) 几乎 不 影响 平 
台 的 定位 误差 。 此 外 并 联机 构 对 尺度 不 甚 敏感 ( 同 
样 的 构 型 可 同时 用 于 大 型 和 小 型 机 器 人 ) ， 而 且 几 乎 
所 有 的 驱动 器 和 传动 方式 都 可 用 于 开发 并 联机 器 人 ， 
比如 线 传动 (参见 Robocrane!® 5! ) 。 并 联机 器 人 主要 
的 缺点 是 工作 空间 较 小 且 工 作 空间 内 可 能 存在 奇异 
位 形 。 

除了 Gough 平台 ， 设 计 最 成 功 的 并 联机 器 人 是 
Clavel ^ 9 设计 的 Delta 机 器 人 (SLA 12.2). 以 及 一 
些 平面 并 联机 器 人 。 最 常见 的 平面 并 联机 器 人 有 3 条 
完全 一 样 的 RPR 或 RRR 支 链 ， 有 下 划 线 的 运动 副 为 
驱动 副 。 这 些 机 器 人 党 被 表示 为 3-RPR ( 见 图 12.3) 
或 3-RRR。 


Delta 4 


^ 


图 12.2 Delta 机 器 人 


图 12.3 平面 并 联机 构 (3-R PR) 


Delta 机 器 人 支 链 中 连 杆 与 运动 副 的 几何 分 布 决 
定 了 动 平台 具有 3 个 移动 自由 度 。 近 年 来 很 多 新 的 
并 联机 器 人 被 设计 了 出 来 ， 尽 管 大 多 数 已 有 的 结构 
都 是 基于 设计 者 的 灵感 ， 但 并 联机 构 的 型 综合 可 以 
系统 地 加 以 实现 。 下 一 节 将 概述 并 联机 构 型 综合 的 
主要 方法 。 


12.2 并联 机构 的 型 综合 


根据 动 平台 给 定 的 运动 模式 设计 出 所 有 可 行 的 并 
联结 构 是 个 具有 挑战 性 的 难题 。 一 些 学 者 致力 于 研究 
这 个 问题 ， 并 称 其 为 型 综合 。 该 领域 内 所 提出 的 方法 
可 分 为 3 类 : 

1) 基于 图 论 的 方法 : 列举 出 具有 一 定数 目 自由 
度 的 所 有 可 能 的 构 型 的 依据 在 于 : 运动 副 的 种 类 和 数 
量 是 有 限 的 ， 因 此 可 能 构 型 的 数量 尽管 可 能 很 大 , 但 
毕 竞 也 是 有 限 的 (例如 参考 文献 [12.7])。 经 典 的 
自由 度 计 算 公 式 ， 比 如 Chebychev- Grübler- Kutzbach 
公式 ， 可 被 用 于 计算 构 型 的 自由 度数 目 。 遗 憾 的 是 ， 
这 些 公式 没有 考虑 构 型 的 几何 特性 可 能 会 引发 平台 自 
由 度数 目的 改变 。 因 此 ， 严 格 基于 图 论 的 型 综合 方法 
只 能 得 到 有 限 的 结果 ， 其 基本 上 已 被 其 他 两 种 方法 所 
取代 


2) 基于 群 论 的 方法 : 刚体 的 运动 具有 位 移 群 的 
独特 结构 。 位 移 群 的 子 群 ， 比 如 说 平移 或 所 有 平行 于 
某 已 知 矢量 的 运动 (Schonflies 运动 ) 都 是 很 重要 的 ， 
因为 当 子 群 中 的 元 素 作用 于 同一 刚体 上 时 利用 取 交 集 
运算 '” 可 将 其 合并 。 型 综合 主要 就 是 确定 可 用 作 机 
器 人 “ 腿 ” 的 不 同 的 支 链 所 属 的 所 有 可 能 的 子 群 ， 且 
这 些 子 群 的 交集 就 是 期 望 的 动 平台 的 运动 模式 。 这 种 
基于 群 论 的 型 综合 方法 发 现 了 许多 可 能 的 构 型 。 不 过 
位 移 群 的 某 些 独特 特性 并 不 能 仅 通 过 群 的 结构 来 反映 ， 
且 这 种 方法 仅 适 用 于 能 被 位 移 群 子 群 所 描述 的 运动 
模式 。 

3) 基于 螺旋 理论 的 方法 : 此 法 的 第 一 步 是 确定 
与 期 望 的 动 平 台 速度 运动 螺旋 互 逆 的 力 螺 旋 系 $。 然 
后 就 可 得 到 运动 支 链 的 力 螺 旋 ， 这 些 力 螺旋 的 并 集 下 
张 成 力 螺 旋 系 S (根据 力 螺旋 系 可 确定 所 有 可 能 的 对 
应 相应 力 螺旋 的 支 链 结构 )。 还 有 一 点 就 是 既然 所 涉 
及 的 运动 螺旋 和 力 螺旋 都 是 瞬时 的 ， 所 以 有 必要 核实 
动 平台 的 运动 是 否 为 全 周期 而 不 是 瞬时 的 。 参 考 文献 
[12.9] 演示 了 该 法 系统 的 应 用 过 程 。 
利用 这 些 型 综合 方法 设计 出 了 本 书 难以 一 一 列 
举 的 大 量 的 构 型 ， 在 Merlet** "的 网 站 中 对 大 量 构 
型 进行 了 综合 的 描述 。 此 外 近 几 年 还 提出 了 一 些 引 人 


= 
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注目 的 完全 或 部 分 运动 解 耦 的 构 型 ， 动 平台 的 运动 是 
平 动 或 Sechinflies 运动 ( 见 参 考 文献 [12.9] 及 其 参 
考 文献 ) 。 

还 需 指 出 的 是 对 于 少 于 六 自由 度 的 并 联机 器 人 ， 
型 综合 的 结果 往往 是 几何 约束 苛刻 的 构 型 ( 比如 Delta 
机 器 人 ， 平 行 四 边 形 的 轴线 需 平 行 且 边 长 相等 ) 。 这 
些 约束 在 现实 中 很 难 完全 满足 ， 因 此 末端 执行 器 将 表 
现 出 一 些 伴随 运动 ， 即 不 期 望 的 运动 。 目 前 未 解决 的 
问题 有 : 

1) 对 给 定 的 机 器 人 而 言 如 何 确定 其 工作 空间 内 
伴随 运动 的 最 大 幅 值 。 

2) 如 何 确定 给 定 构 型 的 几何 参数 以 使 伴随 运动 
的 最 大 幅 值 小 于 给 定 的 阔 值 。 


12.3 ”运动 学 
12.3.1 ŽE 


对 并 联机 右 人 来 说 ， 首 运动 学 的 解 往往 简单 明 
了 。 这 一 点 可 通过 Gough 平台 来 加 以 说 明 。 求 解 逆 运 
动 学 的 关键 问题 在 于 确定 某 一 给 定 平台 位 姿 所 对 应 的 
退 长 g， 而 平台 的 位 姿 是 由 平台 上 的 某 一 给 定点 相对 
固定 坐标 系 的 位 置 矢量 p 以 及 动 平 台 相 对 固定 坐标 系 
的 旋转 矩阵 R 共同 确定 的 。 令 a; Xo CHE i 与 静 平 
台 的 交点 相对 固定 坐标 系 的 位 置 拓 量 ，b, 表示 支 链 i 
与 动 平 台 的 交点 相对 固 联 在 动 平 台 上 的 某 一 坐标 系 的 
TERE, XPE i 的 长 度 即 为 两 点 间 矢量 的 模 ， 将 两 
点 间 的 矢量 记 作 s;,， 可 写 为 

Ss;=p+Rb,—a,,i=1,.…,6 (12.1) 

车 已 知 动 平 台 的 位 姿 ( 即 已 知 矢量 p 和 R)， 即 
可 利用 式 (12.1) 方便 地 算出 矢量 s,， 则 即 可 获知 
腿 长 。 
12. 3.2” 正 运动 学 

求解 正 运动 学 问题 的 关键 在 于 利用 给 定 的 驱动 关 


遇 到 两 种 情况 ,一 是 动 平台 当前 的 位 姿 未 知 ( 比如 
启动 机 构 时 ) ， 一 是 已 知 相对 准确 的 平台 位 姿 (比如 
在 实时 控制 中 ， 正 运动 学 问题 已 在 上 一 次 采样 时 得 到 
了 解决 ) 。 第 一 种 情况 时 唯一 的 已 知 方法 是 确定 逆 运 
动 学 的 所 有 解 ， 虽 然 还 没有 已 知 的 算法 来 拣选 所 得 到 
的 解 。 确 定 实数 解 的 数量 的 上 限 往往 是 可 以 做 到 的 ， 
比如 考虑 平面 3-RPR 机 构 ( 见 图 12.3)， 如 果 将 点 
B, 处 的 关节 拆 开 ， 将 得 到 两 个 分 离 的 机 构 ， 一 个 是 
四 杆 机 构 ， 一 个 是 旋转 机 构 。 根 据 四 杆 机 构 的 运动 学 
可 知 点 B, 的 运动 轨迹 是 一 个 6 次 的 代数 曲线 。 同 时 
可 知 旋转 机 构 上 的 点 B, 的 运动 轨迹 是 一 个 圆 ， 即 2 
次 代数 曲线 。 对 一 组 给 定 的 驱动 关节 广义 坐标 ， 如 果 
两 曲线 相交 ， 即 机 构 可 被 组 合 ， 则 正 运 动 学 有 解 。 由 
贝 祖 定理 (Bezout’s theorem) 可 知 两 条 分 别 为 m 次 和 
n 次 的 代数 曲线 将 有 nm 个 交点 ， 即 两 曲线 次 数 之 积 。 
对 平面 3 -RPR 机 构 而 言 ， 两 条 轨迹 曲线 将 有 12 个 
交点 。 但 12 个 点 中 包括 两 个 虚 圆 点 ， 它 们 位 于 四 杆 
机 构 的 耦合 曲线 以 及 任 一 圆 上 ， 因 此 也 属于 交点 。 依 
据 贝 祖 定理 这 两 个 点 被 计算 了 3 次 ， 故 正 运动 学 问题 
至 多 有 6 个 实数 解 ， 分 别 对 应 6 个 交点 。 

求 运 动 学 正解 已 有 多 种 方法 : Wook?) XE 
BEEP Grébner HEE ER EX BIA, qj 
元 法 往往 不 稳定 〈 可 能 产生 伪 解 或 遗漏 解 ) ， 除 非 在 
解 单 变量 方程 以 及 消 元 时 特别 小 心 ， 比 如 把 多 项 式 解 
EAL Ay Be AE (EL Wiad "P'S 。 而 多 项 式 连续 法 则 稳定 得 
多 ， 因 为 其 具有 成 熟 的 算法 '“"”。 最 快 的 方法 一 一 
但 也 达 不 到 实时 应 用 的 要 求 是 Gróbner 基 法 和 区 
间 算 法 。 可 被 数值 证 明 是 它们 的 一 个 优势 (AN 
漏 解 ， 还 可 以 任意 精度 来 求解 ) 。 

其 实 对 最 简单 的 算 例 ， 消 元 法 往往 也 很 稳定 。 比 
如 平面 3-RPR 机 构 ( 见 图 12.3)， 其 固定 坐标 系 以 


点 4 为 原点 ， 且 x 轴 通 过 点 4,。 类 似 地 ， 运 动 坐 标 
系 的 原点 为 点 B, « 轴 通 过 点 B,。 则 动 平台 的 位 姿 


可 利用 点 B, 相对 固定 坐标 系 的 坐标 (x, y) 以 及 两 
个 坐标 系 的 x 轴 的 夹 角 9 来 确定 。 则 杆 1 的 长 度 g, 可 


节 广 义 坐 标 (给 定 的 矢量 g) 确定 动 平 台 的 位 姿 。 要 
实现 对 并 联机 器 人 的 控制 、 标 定 以 及 运动 规划 就 必须 
求解 正 运 动 学 问题 。 

求解 并 联机 构 的 正 运动 学 问题 往往 比 求解 逆 运 动 
学 问题 要 复杂 得 多 。 式 (12.1) 这 样 封闭 的 方程 是 
典型 的 关于 动 平 台 位 姿 变量 的 高 度 非 线性 的 表达 式 。 
式 (12.1) 组 成 的 非 线性 方程 组 一 般 都 有 多 解 ( 例 
如 Gough 平台 最 多 会 有 40 个 解 "~ 中， 参考 文献 
[12.14] 提供 了 一 个 具有 独特 几何 特性 的 Gough F 
台 的 解 的 个 数 的 表格 ) 。 求 解 正 运动 学 问题 时 可 能 会 


被 简单 表示 为 


qi =x ty (12.2) 

其 他 连 杆 的 长 度 q; 可 被 表示 为 
q =x +y +g (x,y,0) ,i=2,3 (12.3) 
A, gx y 的 线性 表达 式 。 用 式 (12.3) 


减 去 杆 1 的 长 度 则 得 到 关于 x Aly 的 1 个 线性 的 二 
元 一 次 方程 组 。 解 方程 组 则 可 得 到 x 和;y 关 于 9 的 
解析 式 。 再 将 x F y 关于 0 的 解析 式 代 入 式 (12.2) 
则 可 得 未 知 变量 9 的 一 元 方程 。 该 方程 中 未 知 变量 
0 是 以 正弦 和 余弦 的 形式 出 现 的 ， 通 过 Weierstrass 
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变换 方程 将 变 为 1 个 关于 变量 7T(7=tan(92)) 的 6 
阶 方程 。 解 此 方程 即 可 获得 所 有 可 能 的 90， 进一步 
即 可 计算 出 x 和 y。 注 意 该 方程 是 最 低 的 次 数 ， 因 为 
实数 解 的 个 数 不 可 能 超过 6。 这 也 表明 机 构 存 在 正 
运动 学 的 6 个 实数 解 所 对 应 的 位 姿 。 最 后 需要 指出 
的 是 3-RRR 机 构 的 正 运动 学 问题 在 数学 上 是 与 前 述 
IK) 3- RPR 机 构 一 致 的 。 这 对 并 联机 构 来 说 是 很 典 
型 的 。 

如 果 已 知 一 个 先 验 值 ( 解 的 预测 值 )， 则 常 利用 
Newton- Raphson 迭代 法 或 Newton- Gauss 迭代 法 来 解 
决 正 运动 学 问题 。 道 运动 学 问题 的 解 可 写作 


q -f(x) (12. 4) 
Newton- Raphson 法 的 第 次 迭代 可 写作 
X, =X, * A(q -f(x,)) (12.5) 


A, q 是 指定 的 关节 变量 。 和 矩阵 4 通常 为 
(3f/0q) ' (x,) (并 非 每 步 迭 代 都 要 计算 逆 和 矩阵 ， 
亦 可 被 取 作 常数 )。 当 矢量 之 差 (q-f (xk)) 的 模 
小 于 选 定 的 阔 值 时 迭代 将 终止 。 

道 运动 学 方程 的 选择 在 很 大 程度 上 将 决定 该 法 能 
fiue IT 7 ped d 4 Gough 平台 来 说 可 使 用 最 
少数 量 的 方程 (包含 6 个 变量 的 6 个 方程 3 个 平 动 
变量 和 3 个 转角 变量 ) ， 不 过 也 可 用 其 他 形式 的 方程 
组 。 比 如 动 平台 上 3 DAA (ESER IZA) 
的 位 置 坐 标 一 一 相对 固定 坐标 系 一 一 可 被 用 作 未 知 量 
(很 容易 计算 剩余 的 3 个 锚 点 的 坐标 )。 应 用 这 样 多 
表达 形式 则 需要 9 个 方程 。 其 中 6 个 方程 可 根据 动 、 
静 平台 之 间 锚 点 的 已 知 长 度 写 出 ， 另 3 个 方程 可 根据 
被 选择 作为 未 知 量 的 动 平 台 上 的 3 个 锚 点 之 间 的 已 知 
距离 关系 写 出 。 

如 有 1 个 好 的 先 验 值 ，Newton- Raphson 的 计算 
速度 通常 还 是 很 快 的 。 然 而 程序 有 可 能 不 收 僵 ， 或 
PEW, KAF- SERIFER MZ, MAFA 
一 种 构 型 所 对 应 的 平台 位 姿 。 这 种 情况 即使 在 先 验 
值 接近 正确 位 姿 时 也 会 发 生 。 如 果 将 所 得 到 的 结果 
直接 用 于 控制 则 后 果 会 很 严重 。 好 在 可 利用 结合 
诸如 Kantorovitch 定理 之 类 的 数学 工具 的 区 间 算 法 来 
判断 Newton- Raphson 法 的 解 是 否 为 机 构 正 确 的 位 
次 ， 尽 管 利用 了 更 多 的 机 时 来 验证 结果 ， 不 过 依然 
还 是 实时 计算 "|。 

男 一 种 可 行 的 求解 正 运 动 学 问题 的 方法 是 给 被 动 
关节 (比如 Gough 平台 中 的 虎 克 贸 ) 添加 传感器 或 
者 增加 关节 具有 传 感 功能 的 被 动 支 链 。 该 法 主要 的 问 
题 一 方面 是 确定 能 计算 出 动 平 台 唯 一 位 姿 的 传感器 的 
数量 及 其 安装 位 置 王 ”21 ， 另 一 方面 是 确定 传感器 
的 误差 对 平台 定位 误差 的 影响 。 比 如 Stoughton 就 提 
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到 对 于 在 虎 克 饺 上 安装 了 传 感 需 的 Gough 平台 来 说 ， 
仍然 有 必要 使 用 Newton- Raphson 方法 以 提高 解 的 精 
度 ， 因 为 利用 传感器 数据 所 计算 得 到 的 平台 位 姿 对 测 
量 噪 声 非常 敏感 "2 。 


12.4 速度 和 精度 分 析 
与 串联 机 构 类 似 ， 并 联机 构 驱 动 副 的 速度 矢量 q 
与 动 平台 的 移动 和 转动 速度 线性 相关 (为 简单 起 见 ， 
动 平台 的 速度 矢量 在 此 被 表示 为 p ， 尽 管 平台 角速度 
不 是 任何 角度 的 时 间 导 数 ) 。 两 矢量 之 间 的 线性 映射 
关系 可 用 雅 可 比 矩 阵 表示 为 
p =J(p)4q (12. 6) 
然而 对 于 并 联机 构 来 说 ， 封 闭 形 式 的 雅 可 比 和 矩阵 
HX BE 7 一 往往 是 可 以 写 出 的 ， 但 要 写 出 封闭 形式 
的 雅 可 比 矩 阵 了 却 要 困难 得 多 (更 确切 地 说 ， 大 多 
数 六 自由 度 的 并 联机 构 封闭 形式 的 雅 可 比 矩 阵 的 形式 
是 如 此 繁杂 以 至 于 在 现实 中 根本 无 法 应 用 ) 。 比 如 在 
Cov 纪 平台 简单 的 静 力 学 分 析 中 雅 可 比 抢 阵 的 逆 和 矩阵 
J Ry itt, HB JI! ， 可 写作 
Ji =n; (ci xn;)" (12.7) 
SUP, n, 为 沿 支 链 i 方 向 的 单位 矢量 ，c, 是 固 联 在 动 
平台 上 的 运动 坐标 系 的 原点 与 动 平 台 上 第 i 个 锚 点 之 
间 的 矢量 。 
关节 传 感 误差 Aq 对 定位 误差 Ap 的 影响 也 符合 
这 样 的 关系 ， 即 


Ap=J(p)Ag (12. 8) 
PAA TE RT FEAR ME J 的 封闭 形式 很 难得 到 ， 并 联 
机 构 的 精度 分 析 ( 即 在 给 定 的 工作 空间 内 由 关节 传 
感 误 差 确定 最 大 的 定位 误差 ) 的 难度 也 比 串联 机 构 
KBP PT 。 抛 开 测量 误差 不 谈 ， 并 联机 构 中 还 
有 一 些 误 差 源 : 被 动 副 的 间隙 、 制 造 公 差 、 热 误差 
以 及 重力 引发 的 动态 误差 *"””*，。 参考 文献 
[12.27 -29] 研究 了 串联 机 构 和 并 联机 构 的 关节 间 
际 对 路 径 跟 踊 的 有 影响。 这些 人 研究 表明 不 可 能 确定 几 
何 误差 的 影响 趋势 : 因为 影响 程度 高 度 依赖 于 机 构 的 
结构 、 尺 寸 以 及 工作 空间 ， 所 以 必须 一 对 一 进行 分 
Ho SRR Da SCE ABE ABA?! BAH 
也 能 稍微 降低 一 些 热 的 影响 ,但 发 热 有 时 被 视 
作 可 能 的 误差 源 。 
正如 第 3 章 中 谈 到 的 那样 ， 标 定 是 提高 并 联机 
构 精 度 的 另 一 种 方法 。 不 过 并 联机 构 标 定 的 方法 和 
过 程 与 串联 机 构 还 是 略 有 不 同 ， 因 为 一 方面 对 并 联 
机 构 来 说 只 有 道 运动 学 方程 是 已 知 的 ， 另 一 方面 并 
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联机 构 的 定位 精度 对 几何 误差 的 敏感 程度 也 远 没 有 
串联 机 构 那 么 高 ”| 。 而 标定 时 产生 的 测量 噪声 
影响 巨大 甚至 会 导 臻 令 人 吃惊 的 结果 。 比 如 即使 考 
虑 了 测量 噪声 "*” ， 经 典 的 最 小 二 乘法 也 可 能 会 得 
到 不 满足 某 些 约束 方程 的 参数 。 一 些 实验 数据 还 表 
明 经 典 的 并 联机 构 的 模型 会 导致 约束 方程 不 存在 任 
何 与 测量 噪声 无 关 的 解 ，、*” 。 此 外 ， 标 定 还 对 位 姿 
Tug 707. 看 上 去 位 于 工作 空间 边界 上 的 位 姿 
是 最 佳 的 选择 "| 。 


12.5 奇异 分 析 


12.5.1 通用 公式 


并 联机 构 的 奇异 分 析 最 早 是 由 Gosselin 和 Angel- 
es 开始 研究 的 "*”。 在 下 面 的 式 子 中 ， 运 动 学 方程 
被 简化 为 了 驱动 关节 广义 坐标 q 与 动 平 台 笛 卡 儿 坐标 
矢量 p 的 输入 输出 关系 


fap) =0 (12.9) 
将 式 (12.9) 关于 时 间 求 导 ， 得 
Bq +Ap =0 (12. 10) 


由 此 可 定义 3 种 奇异 : 

1) HEB 奇异 ( 称 作 串 联 奇 异 )。 

2) EEA 奇异 ( 称 作 并 联 奇 异 ) 。 

3) 输入 输出 方程 退化 〈 称 作 结 构 奇 异 ) ， 此 时 
Fa: B ASEM A 可 能 会 同时 奇异 。 

发 生 串 联 奇异 时 ， 驱 动 关 节 的 输出 不 为 零 ， 但 动 


失去 对 机 器 人 的 控制 。 在 奇异 位 形 的 邻 域内 关节 力 / 
力矩 还 可 能 会 变 得 很 大 ， 有 可 能 会 造成 机 器 人 的 损 
坏 。 本 节 拟 讨论 的 主要 话题 是 : 

1) 奇异 的 特性 。 

2) 表征 位 姿 接 近 奇 异 的 程度 的 性 能 指标 定义 。 

3) 在 给 定 工作 空间 内 或 运动 轨迹 上 判断 是 否 存 
在 奇异 位 姿 的 算法 的 研究 进展 。 

2 6x6 阶 的 雅 可 比 矩 阵 的 逆 和 矩阵 ( 动 平台 的 运 
动 螺 旋 与 主动 副 (最 终 还 包括 被 动 副 的 输出 速度 之 
间 的 映射 矩阵 ) 奇异 时 ， 即 其 行列 式 det (J) AE 
时 ， 并 联机 器 人 将 发 生 奇 异 。 要 指出 的 是 之 所 以 有 时 
必须 要 考虑 被 动 副 的 输出 速度 的 原因 是 : 仅 限于 考虑 
主动 副 的 输出 速度 可 能 会 导致 无 法 确定 机 器 人 所 有 的 
奇异 位 姿 (示例 参见 3- UPU BUEUT 93), 。 通 常 进 行 
恰当 的 速度 分 析 后 便 可 得 到 封闭 形式 的 矩阵 ， 但 计算 
其 行列 式 的 值 却 有 可 能 是 很 困难 的 ， 即 使 是 使 用 软件 
的 符号 求解 功能 (示例 参见 Gough PRH), X 
法 的 优势 在 于 一 旦 得 到 了 算 阵 行列 式 的 解析 表达 式 就 
可 画 出 工作 空间 内 奇异 位 姿 的 轨迹 ， 而 且 这 种 图 形 化 
的 表示 方法 有 助 于 机 构 的 设计 。 然 而 行列 式 的 解析 表 
达 式 往往 本 身 就 很 复杂 ， 以 至 于 无 法 通过 它 获悉 机 构 
发 生 奇异 的 几何 条 件 。 

另 一 种 方法 是 利用 线 素 几何 学 ， 对 于 部 分 并 联机 
Kg (尽管 不 是 全 部 )，J 的 行 元素 对 应 1 个 由 定义 在 
机 构 连 杆 上 的 某 条 直线 的 Pliicker 坐标 所 确定 的 矢量 。 
比如 Gough FR, J, 的 行 元 素 就 对 应 与 支 链 相关 联 的 
直线 的 规格 化 Plücker 坐标 。 仅 在 这 些 矢 量 所 对 应 的 


a 


平台 处 于 静止 状态 。 发 生 并 联 奇异 时 ， 驱 动 关节 的 输 
出 为 零 ， 但 动 平台 可 能 处 于 运动 状态 。 在 奇异 位 姿 的 
邻 域内 ， 锁 定 所 有 驱动 器 时 动 平 台 还 可 能 会 有 微小 的 
运动 。 当 驱动 器 被 锁定 时 末端 执行 器 的 自由 度 本 应 该 
为 零 ， 但 机 构 处 于 奇异 位 姿 时 就 好 像 又 获得 了 一 些 无 
法 被 控制 自由 度 ， 这 是 一 个 大 问题 。 


直线 满足 某 种 独特 的 几何 约束 时 才 会 发 生 奇异 "*“ 
(比如 3 个 Plücker 矢量 所 对 应 的 相交 且 共 面 的 直线 当 
且 仅 当 它们 交 于 一 点 时 才 会 线性 相关 ) ， 而 和 矩阵 J 的 
奇异 就 意味 着 这 些 矢 量 之 间 线 性 相关 (它们 组 成 了 
一 个 线性 线 从 ) 。Grassmann 已 给 出 了 3 、4、5、6 个 
矢量 相关 的 几何 约束 。 由 此 奇异 分 析 就 旷 变 成 了 判定 


Zlatanov ^ 9! 对 奇异 位 形 进 行 了 更 为 广泛 的 研究 。 
他 应 用 了 包含 末端 执行 器 的 全 部 的 运动 旋 量 以 及 所 有 
关节 (主动 副 和 被 动 副 ) 速度 的 速度 方程 来 进行 研 
究 。 利 用 这 种 方法 不 仅 提 出 了 更 详细 的 奇异 分 类 ， 后 
来 还 被 用 于 研究 使 用 参考 文献 [12.39] 中 的 方法 无 
法 发 现 的 特殊 奇异 ( 称 作 约 束 奇 异 ) TU, 


位 姿 参 数 是 否 满足 了 一 些 约束 条 件 ， 并 给 出 奇异 簇 的 
几何 信息 。 封 闭 形 式 的 奇异 条 件 可 被 代入 雅 可 比 矩 
阵 ， 并 通过 计算 矩阵 的 核 来 判定 奇异 运动 !“ ”1 。 
判别 某 一 位 姿 与 奇异 位 姿 的 接近 程度 是 一 个 难 
题 : 目前 还 没有 任何 可 定义 某 一 位 姿 与 给 定 的 奇异 位 
姿 之 间距 离 的 数学 度量 。 因 此 在 定义 与 奇异 位 姿 的 距 


上 述 的 奇异 分 析 都 是 一 阶 的 ， 当 然 也 可 以 进行 二 
阶 〈 以 及 更 高 阶 ) 的 奇异 分 析 ， 但 这 些 分 析 就 要 复 


杂 得 多 了 [12.29,42] " 
12.5.2 ”并 联 奇异 分 析 
这 种 奇异 对 并 联机 构 来 说 特别 重要 ， 因 为 此 时 将 


离 时 就 难免 会 有 些 主观 ， 已 有 的 指标 也 均 不 完美 。 比 
WS ER J, 的 行列 式 值 作为 指标 : 其 不 妥 之 处 在 于 
当 动 平 台 既 平 动 又 转动 时 ， 如 果 旋 转变 换 和 矩阵 的 量 纲 
不 一 致 ， 则 行列 式 的 值 将 会 依据 描述 机 器 人 几何 参数 
的 物理 单位 的 不 同 而 发 生变 化 。11 章 中 定义 的 灵巧 
度 〈 尽 管 所 到 灵巧 度 时 更 多 的 是 针对 串联 机 构 而 
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TOU) 也 可 被 用 作 接 近 程 度 的 指标 ， 还 有 一 些 其 
他 独特 的 指标 用 于 表征 接近 程度 ”| 。 

大 多 数 基于 以 上 指标 的 分 析 都 是 局 部 的 ， 也 就 是 
说 仅 对 某 一 位 姿 是 有 效 的 ， 但 实际 应 用 中 却 需要 在 给 


作 空 间 ， 因 为 几何 的 方法 往往 便于 研究 工作 空间 边界 
的 特性 〈 可 参阅 参考 文献 【12. 60，61] 中 国定 平台 
姿态 后 对 Gough 平台 工作 空间 的 计算 )。 该 法 的 男 一 
个 优点 是 在 计算 工作 空间 的 表面 积 与 体积 时 非常 节省 


定 的 工作 空间 内 或 路 径 上 判定 是 否 会 发 生 奇 异 。 幸 运 
的 是 ， 有 一 种 算法 可 做 到 这 一 点 ， 即 使 机 器 人 的 几何 
模型 并 不 确定 "*” 。 但 也 需要 指出 的 是 对 并 联机 器 
人 来 说 无 奇异 的 工作 空间 并 不 总 是 最 优 的 。 其 他 的 性 
能 要 求 可 能 会 在 工作 空间 内 引入 奇异 ,或 者 机 器 人 的 
部 分 工作 空间 内 无 奇异 点 ( 比如 其 实际 工作 区 域 )， 
而 奇异 点 仅 出 现在 工作 区 域 之 外 。 因 此 规划 一 条 避免 
奇异 同时 又 靠近 给 定 路 径 的 运动 轨迹 是 可 行 的 ， 针 对 
此 问题 也 已 提出 了 不 同 的 方法 "*”?。 

最 后 要 注意 的 是 在 某 些 场合 机 器 人 的 位 姿 接 近 于 
奇异 位 形 时 反而 可 能 是 有 利 的 。 比 如 提高 工作 空间 狭 
小 的 并 联机 器 人 的 定位 精度 以 及 提高 被 用 作 力 传感器 
的 并 联机 器 人 在 某 一 测量 方向 上 的 灵敏 度 “” 时 ， 
末端 执行 器 与 主动 关节 的 速度 之 比 越 大 越 有 利 。 还 需 
注意 的 是 长 期 处 于 奇异 位 姿 的 并 联机 构 非 常 有 趣 ， 因 
为 它们 仅 用 一 个 驱动 器 就 能 产生 复杂 的 运动 0 。 


12.6 工作 空间 分 析 


如 前 所 述 并 联机 构 主 要 的 缺点 之 一 就 是 工作 空间 
较 小 。 相 对 串联 机 构 ， 并 联机 构 的 工作 空间 分 析 也 要 
复杂 得 多 ， 尤 其 是 在 动 平台 的 自由 度数 目 大 于 3 时 。 
动 平 台 的 运动 常常 存在 耦合 ， 这 更 加 剧 了 简单 图 形 化 
表示 工作 空间 的 困难 。 解 而 并 联机 构 尽 管 已 被 设计 出 
来 '*“”-” ,但 它们 的 承载 能 力 不 及 传统 并 联机 构 。 
一 般 地 ， 并 联机 构 的 工作 空间 受到 以 下 因素 的 限制 : 

1) 了 驱动 关节 变量 的 限制 ， 比如 Gough F6 KIS 
链 长 度 必 有 一 个 范围 。 

2) 被 动 关节 的 运动 范围 限制 : 比如 Gough 平台 
的 球 饮 和 席 克 铵 都 会 限制 平台 的 转 劲 范围 。 

3) 机 器 人 内 部 〈 支 链 、 静 平台 和 动 平 台 ) 的 
涉 限制 。 

工作 空间 可 进一步 被 定义 为 灵巧 工作 空间 CP 
台 上 某 一 参考 点 可 以 从 任何 方向 到 达 的 点 的 集合 )、 
最 大 可 达 工 作 空间 (平台 上 某 一 参考 点 可 以 达到 的 
所 有 点 的 集合 ) 以 及 定向 工作 空间 ( 动 平台 在 固定 
位 姿 时 执行 右 端 点 可 达 的 点 的 集合 ) 。 

确定 自由 度 大 于 3 的 并 联机 器 人 的 工作 空间 的 一 
个 方法 是 固定 -3 个 位 姿 参数 而 只 绘制 剩余 的 3 个 
自由 度 所 确定 的 工作 空间 。 如 果 所 剩余 的 3 个 自由 度 
均 为 移动 自由 度 ， 则 利用 几何 方法 可 快速 地 绘制 出 工 


存储 空间 。 然 而 一 旦 涉及 转动 ， 几 何方 法 就 会 变 得 相 
当 复杂 。 此 时 蔡 代 方 法 有 : 

1) 离散 化 方法 : 检验 若干 个 n 维 点 对 应 的 位 姿 ， 
如 果 该 位 姿 满 足 所 有 运动 约束 则 该 点 对 应 一 个 工作 空 
间 内 的 位 姿 。 该 法 计算 量 很 大 因为 随 着 检测 点 的 增多 
所 需要 的 机 时 将 呈现 指数 级 的 增长 ， 同 时 还 需要 具备 
较 大 的 存储 空间 。 但 另 一 方面 ， 离 散 化 方法 具有 简单 
可 行 的 优点 ， 且 便于 考虑 所 有 的 约束 ， 因 为 对 某 一 确 
定 的 平台 位 姿 来 说 运动 约束 往往 是 容易 确定 的 。 

2) 可 确定 工作 空间 边界 的 数值 计算 方法 "|。 

3) 基于 区 间 算 法 的 数值 计算 方法 ， 可 以 任何 精 
度 来 确定 工作 空间 的 体积 于 “ 。 该 法 也 适用 于 解决 
运动 规划 问题 。 

奇异 可 将 利用 运动 学 约束 计算 得 到 的 工作 空间 分 
隔 成 基本 的 单元 ，Wenger 称 其 为 片 (aspect) 7597, 
然而 对 于 空间 并 联机 构 来 说 如 何 确 定 片 仍 未 得 到 解 
决 。 并 联机 构 也 并 不 是 总 能 从 某 一 片 移动 到 另 一 片 
(至 少 没 考虑 机 构 的 动力 学 特性 "*”)， 因 此 有 效 的 
工作 空间 会 变 小 。 

与 工作 空间 分 析 相 关 的 一 个 问题 是 运动 规划 问 
题 ， 而 并 联机 器 人 的 运动 规划 问题 与 串联 机 器 人 还 是 
有 些 不 同 。 对 于 并 联机 器 人 来 说 ， 规 划 问 题 并 是 在 工 
作 空 间 中 避 障 ， 而 是 要 确定 某 条 路 径 是 否 完 全 位 于 工 
作 空 间 内 或 者 确定 两 位 姿 之 间 的 路 径 上 是 否 不 存在 奇 
异 位 形 。 检 查 路 径 是 否 可 行 的 算法 是 现成 的 "1 但 
确定 这 样 的 路 径 却 很 困难 。 经 典 串 联机 器 人 的 运动 规 
划 是 在 关节 空间 内 进行 的 ， 并 假定 关节 空间 与 作业 空 
间 之 间 存 在 一 一 对 应 的 关系 。 基 于 该 假定 ， 就 有 可 能 
在 关节 空间 内 确定 一 个 不 发 生 干 涉 碰撞 的 点 集 ， 进 而 
再 规划 出 连接 两 位 姿 的 不 发 生 干 涉 碰撞 的 路 径 。 然 而 
这 个 假定 对 并 联机 器 人 来 说 并 不 适用 ， 因 为 关节 空间 
与 作业 空间 之 间 的 映射 并 不 是 一 对 一 的 : 关节 空间 的 
一 个 点 既 有 可 能 对 应 作业 空间 中 的 多 个 点 ， 也 有 可 能 
因为 封闭 方程 得 不 到 满足 而 不 存在 对 应 的 点 。 对 并 联 
机 器 人 来 说 最 有 效 的 运动 规划 方法 看 起 来 应 该 是 考 
虑 一 一 或 在 一 定 程度 上 考虑 一 一 封闭 方程 的 随机 运动 
规划 的 自 适 应 算法 天 921 。 

并 联机 器 人 的 另 一 个 运动 规划 问题 是 只 使 用 部 分 
自由 度 完成 作业 。 比 如 当 一 台 六 自由 度 的 并 联机 器 人 
在 进行 加 工作 业 时 ， 绕 刀具 轴线 转动 的 平台 运动 就 不 
必 参 与 其 中 ， 因 为 驱动 器 输出 轴 的 转动 可 确保 刀具 的 
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转动 。 因 此 不 参与 作业 的 自由 度 便 可 用 于 扩大 作业 空 
间 、 避 开 奇 异 位 形 或 者 优化 机 构 的 某 些 性 能 指 
标 ，””"。 进 而 可 定义 部 件 定位 问题 ， 即 在 机 器 
人 的 工作 空间 内 确定 部 件 的 位 姿 以 使 部 件 的 位 姿 满足 
某 些 约束 ,例如 部 件 应 整体 位 于 工作 空间 之 内 ， 且 在 
其 表面 上 的 每 一 点 上 机 器 人 都 具有 一 定 的 转动 能 力 。 


12.7 静 力 学 分 析 和 静 平 稀 


与 串联 机 器 人 类 似 ， 利 用 雅 可 比 矩 阵 易 实 现 并 联 
机 器 人 的 静 力 学 分 析 。 主 动 副 的 驱动 力 /力矩 7 与 施 
加 在 动 平台 上 的 力 螺旋 了 之 间 的 映射 可 写作 : 

T-J'f (12.11) 
式 中 , J" FE WL ae ACE RI be HE PE BS i ELAB PES SX 
(12.11) 可 用 于 多 种 场合 : 

1) 在 设计 过 程 中 可 确定 驱动 力 /力矩 (以 完成 
驱动 器 选 型 ) 。 此 时 ， 设 计 者 感 兴趣 的 是 寻找 机 器 人 
在 整个 工作 空间 内 所 和 需 的 最 大 驱动 力 /力矩 。 然 而 这 
是 一 个 复杂 的 问题 因为 并 不 知道 封闭 形式 的 JI 。 

2) 当 机 器 人 被 用 作 力 传感器 时 : 如 果 T 已 被 检 
测 出 且 动 平台 的 位 姿 是 已 知 的 ， 则 据 式 (12.11) 即 
可 算出 f, 这 样机 器 人 既是 运动 平台 也 是 传 感 
AREE SEM 

与 串联 机 器 人 类 似 ， 并 联机 器 人 的 刚度 矩阵 K 
被 定义 为 : 


K=J KJ (12. 12) 
式 中 , K Æ IR oy M UE ZH R HO GE fh E E (B Duf- 
fy ^7 JE RTE ed BE ERER SEE, EAD 
对 于 Gough 平台 ， 该 式 假定 连 杆 的 弹性 元 件 上 的 初始 
载荷 为 零 。 假 定 未 施加 载荷 时 连 杆 的 长 度 为 gn ， 则 


i=6 
Af = Y kAgin; +k(q; 一 q;)An, 
i=l 


i=6 
Am = Y kAg,ec; x n; + k;(q; - d) Ce; x nj) 


式 中 k;,， 是 支 链 的 轴 向 刚度 ; n, 是 沿 第 i 条 支 链 方 
向 的 单位 矢量 ; e, 是 运动 参考 坐标 系 的 原点 和 动 平 
合 上 第 i 个 锚 点 之 间 的 矢量 ; f 和 m 分 别 是 施加 在 动 
平台 上 的 外 力 和 外 力矩 。 因 此 式 〈12.12) 中 的 刚 
度 和 矩阵 仅 在 4 = q; 时 才 是 正确 的 ， 故 被 称 为 被 动 
刚度 。 

此 外 ,参考 文献 [12.77] 也 指出 式 (12.12) 
只 有 在 外 力 螺旋 为 零 时 才 是 正确 的 。 上 式 其 实 与 雅 可 
比 矩 阵 取 决 于 机 器 人 的 位 姿 且 随 所 施加 的 外 部 载荷 的 
改变 而 改变 的 事实 不 符 。 参 考 文献 [12.77] 中 提出 
的 公式 ， 即 CCT (Conservative Congruence Transforma- 


tion) ， 考 虑 了 这 些 变化 ， 并 定义 刚度 矩阵 如 下 : 
K.-J KJ «(9J 't/op) (12. 13) 

th, p 为 动 平 台 在 笛 卡 儿 坐 标 系 中 的 位 移 矢 量 ，T 
是 驱动 力 /力矩 矢量。 应 尽 可 能 使 用 式 (12.13) 而 
不 是 式 (12. 12) ， 因 为 前 者 与 实际 机 构 更 为 吻合 。 

另 一 个 有 趣 的 静态 问题 是 并 联机 器 人 的 静 平 衡 。 
几 十 年 来 有 关机 器 人 静 平 衡 的 研究 一 直 都 是 重要 的 内 
容 (比如 参考 文献 [12.78] 介绍 了 静 平衡 的 研究 进 
展 及 最 新 的 研究 成 果 ) 。 只 要 连 杆 的 重力 在 静止 状态 
下 不 产生 作用 力 /力矩 于 驱动 器 上 ， 则 不 论 并 联机 器 
人 处 于 任何 位 姿 其 都 被 认为 会 处 于 静 平衡 。 这 一 条 件 
也 被 称 作 重力 补偿 。 Dunlop. ^?! 在 研究 并 联机 器 人 
的 重力 补偿 时 曾 建 议 使 用 配 重 来 平衡 一 个 用 于 调整 天 
线 方向 的 2 自由 度 并 联机 器 人 ，Jeani2 吕 1 则 研究 了 平 
面 并 联机 器 人 的 重力 补偿 问题 ， 并 提出 了 简单 有 效 的 
平衡 条 件 。 

一 般 来 说 可 利用 配 重 或 弹簧 来 实现 静 平 衡 。 如 果 
使 用 弹簧 ， 则 更 平衡 可 被 定义 为 任何 位 姿 时 机 构 中 势 
能 之 和 (包括 重力 势能 和 弹簧 中 储存 的 弹性 势能 
保持 常数 的 一 组 条 件 。 如 果 不 用 弹 签 或 其 他 储存 弹性 
势能 的 元 件 ， 则 机 器 人 保持 更 平 衡 的 条 件 是 : 无 论 机 
器 人 如 何 运 动 ， 其 重心 位 置 均 保持 在 同一 水 平 高 度 。 

考虑 一 个 n 个 自由 度 的 普通 的 空间 并 联机 右 人 ， 
其 包含 个 运动 部 件 和 一 个 固定 的 基 座 。 若 用 c, 表 
示 第 ;个 活动 部 件 的 重心 相对 固定 坐标 系 的 位 置 矢 
A, Hm, 表示 第 i 个 活动 部 件 的 质量 ， 用 c 表示 机 器 
人 总 重心 相对 固定 坐标 系 的 位 置 矢量 ， 则 有 


c 2d y (12. 14) 
式 中 ，M 是 所 有 运动 部 件 质 量 的 总 和 ， 即 
its ym (12.15) 
一 般 地 ， 矢 量 。 是 机 器 人 位 次 的 函数 ， 即 
c -c(0) (12. 16) 


式 中 , 0 是 机 器 人 所 有 关节 广义 坐标 组 成 的 矢量 。 
若 机 器 人 未 使 用 弹性 元 件 ， 则 项 平衡 的 条 件 可 
写作 


eic=C, (12.17) 
UP, C, 是 一 个 随机 常数 ，e, 是 沿 重 力 方 向 的 单位 
矢量 。 
如 果 机 器 人 使 用 了 弹性 元 件 ， 则 重力 势能 和 弹性 
势能 之 和 ， 记 作 V， 可 写作 


" 
1 
V = ge! > me, + 可 之 万 (5 - £)? 
i=l j=1 


(12.18) 
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AP, g 是 重力 加 速度 常数 ; n, 是 线性 弹性 元 件 的 数 
量 ; 性 是 第 7 个 弹性 元 件 的 弹性 系数 ; * 是 第 7 个 弹性 
元 件 的 长 度 ; sj 是 其 未 变形 时 的 原始 长 度 。 如 前 所 
述 ， 如 使 用 了 弹性 元 件 ， 静 平衡 的 条 件 是 势能 之 和 为 
常数 ， 即 


huj 


V=V. 
SUP, Ve 是 一 个 随机 常数 。 
利用 上 面 给 出 的 通 式 可 获得 指定 机 器 人 处 于 静 平 
衡 的 条 件 。 尽 管 利用 该 方程 一 般 均 可 得 到 充足 的 静 平 
衡 条 件 ， 但 对 于 空间 并 联机 器 人 来 说 ， 求 解 静 平衡 条 
件 的 过 程 往 往 十 分 繁琐 。 一 些 近 期 发 表 的 文献 也 探讨 
了 这 个 问题 中。 另外 一 些 研究 “中 指出 仅 使 用 
配 重 是 无 法 保证 6- UPS 并 联机 器 人 在 任何 位 姿 下 都 
能 实现 静 平 衡 的 。 而 参考 文献 "中 推 荐 了 一 些 仅 
用 弹簧 即 可 实现 静 平衡 的 替代 构 型 (含有 平行 四 
JE). 
静 平衡 的 后 续 研 究 自然 是 动 平 衡 。 动 平衡 的 研究 
目的 是 实现 基 座 在 机 器 人 工作 过 程 中 不 会 受到 运动 部 
件 的 冲击 。 动 平衡 问题 可 分 为 平面 并 联机 器 人 的 动 平 
衡 问 题 以 及 空间 并 联机 器 人 的 动 平衡 问题 。 参 考 文献 
[12.86] 认为 可 对 自由 度数 目 不 多 于 6 的 动 平衡 的 
并 联机 器 人 进行 型 综合 ， 虽 然 最 终 得 到 的 构 型 可 能 会 
很 复杂 。 


(12. 19) 


= 党 


12.8 动力 学 分 析 


并 联机 器 人 的 动力 学 模型 在 形式 上 与 串联 机 器 人 

(参见 第 2 XE) 很 相似 ， 即 
M(x) p +C(p.q,p.q) *G(p,q) =T 

(12. 20) 
式 中 ，M 是 正定 的 广义 惯量 矩阵 ;，G 是 重力 项 ; C 是 
离心 力 和 科 氏 力 项 。 但 并 联机 器 人 此 模型 的 建立 则 要 
困难 得 多 ， 因 为 需 满足 封闭 方程 。 并 联机 右 人 动力 学 
建 模 的 经 典 方法 是 先 找 到 1 个 等 效 的 树 型 结构 ， 然 后 
再 利用 拉 格 朗 日 乘 子 或 已 被 参考 文献 [12. 89] 所 证 明 
了 的 阿尔 伯 特 原理 添加 运动 学 约束 '*”*]。 其 他 的 一 些 
方法 主要 基于 虚 功 原理 ”~”」、 拉 格 朗 日 方程 ”| 、 
nara OUR GRUT PUR Aeg cr) Re omma 
并 联机 器 人 动力 学 模型 往往 十 分 复杂 ， 因 为 建 模 
过 程 中 需要 确定 一 些 不 易 精 确 量化 的 动力 学 参数 ， 此 
外 建 模 还 涉及 正 运动 学 的 求解 。 因 此 动力 学 建 模 的 计 
FERK, 但 同时 又 必须 满足 实时 性 要 求 。 

参考 文献 [12.104, 105] 讨论 了 如 何 利 用 动力 
学 模型 来 辅助 实现 对 机 絮 人 的 控制 ， 多 是 在 自 适 应 控 


制 过 程 中 在 线 地 利用 跟踪 误差 来 修正 动力 学 方程 中 的 
UIS 虽然 在 普通 的 六 自由 度 并 联机 响 
人 下 和 振动 平台 i* "上 也 有 一 些 应 用 , 但 控 
制 律 主要 还 是 用 于 平面 并 联机 器 人 以 及 Delta 机 器 
人 下- 中 。 然而 对 六 自由 度 并 联机 器 人 来 说 ， 利 用 
动力 学 模型 来 提高 运动 速度 的 做 法 往往 收效 甚 微 ， 因 
为 动力 学 模型 的 计算 量 太 大 了 。 

并 联机 器 人 能 以 比 串联 机 器 人 大 得 多 的 速度 和 加 
速度 进行 作业 ， 比 如 有 些 Delta 机 器 人 的 加 速度 可 达 
S00m/s^, ， 而 线 驱动 机 吉 人 的 加 速度 甚至 会 更 大 。 

最 后 ， 减 小 工作 空间 内 机 器 人 惯量 的 波动 将 有 助 
于 优化 并 联机 器 人 的 动力 学 性 能 :2 。 


12.9 设计 

机 器 人 的 结构 设计 可 分 为 两 个 主要 的 阶段 

1) 结构 综合 : 确定 机 器 人 所 要 采用 的 构 型 。 

2) 尺度 综合 : 确定 构 型 的 几何 参数 值 (此 处 的 
几何 参数 是 广义 的 ， 比 如 可 能 涉及 的 质量 和 惯量 ) 。 

12. 2 讨论 过 结构 综合 〈 型 综合 ) 的 问题 。 然 而 
除了 运动 形式 以 外 还 要 在 设计 阶段 考虑 性 能 要 求 。 串 
联机 器 人 的 优势 在 于 可 能 的 构 型 数量 相对 较 少 ， 而 其 
中 的 一 些 构 型 在 某 些 性 能 方面 又 比 其 他 构 型 具有 明显 
的 优势 ( 比如 3 个 转动 副 串 联 而 成 的 关节 式 机 器 人 
的 工作 空间 就 比 外 形 尺 十 差不多 的 直角 坐标 式 机 器 人 
的 工作 空间 大 得 多 ) 。 

遗憾 的 是 并 联机 器 人 并 不 是 这 样 ， 不 仅 存 在 大 量 
可 能 的 构 型 设计 方案 ， 而 且 构 型 的 性 能 还 对 几何 参数 
十 分 敏感 。 比 如 说 在 指定 的 工作 空间 内 ， 平 台 半 径 
10% 的 变化 就 可 能 使 Gough 平台 的 极 值 刚 度 变 为 原来 
的 700% 。 因 此 ， 结 构 综合 与 尺度 综合 密 不 可 分 。 事 
实 上 据 推测 ， 构 型 不 是 最 优 但 参数 设计 合理 的 机 器 人 
完成 任务 时 的 表现 一 般 也 会 比 看 起 来 构 型 优异 但 参数 
设计 不 合理 的 机 器 人 要 好 。 

通常 设计 过 程 常 被 看 作 优 化 问题 。 每 一 个 特定 的 
性 能 要 求 均 与 某 一 项 性 能 指标 相关 联 ， 该 指标 会 随 着 
性 能 要 求 不 被 满足 的 程度 的 加 剧 而 升 高 。 这 些 性 能 指 
标 全 都 被 归纳 在 一 个 加 权 的 且 被 称 作成 本 函数 的 实数 
函数 里 ,该 函数 本 质 上 是 几何 参数 的 函数 ， 然 后 利用 
一 个 数值 计算 的 优化 程序 寻找 使 函数 取 极 小 值 的 几何 
参数 值 ( 因此 该 法 就 是 优化 设计 )"*"“-" [Hei 
也 有 很 多 缺陷 : 成 本 函数 中 的 权重 系数 的 大 小 和 效果 
很 难 确定 ; 必要 的 要 求 很 难 被 导入 函数 且 会 使 优化 过 
程 非常 复杂 ; 定义 性 能 指标 也 很 重要 等 等 ， 以 上 仅 列 
举 几 项 。 主 要 的 问题 可 表述 如 下 : 
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D) 谈 到 最 终 设计 中 的 不 确定 因素 就 不 能 不 考虑 
使 用 成 本 函数 而 得 到 的 设计 方案 的 鲁 棒 性 。 因 为 存在 
制造 误差 以 及 一 些 机 械 系 统 内 在 的 不 确定 因素 ， 最 终 
的 样机 总 会 与 原理 设计 方案 有 所 差异 。 

2) 性 能 要 求 有 时 也 是 互相 矛盾 的 〈 例 如 工作 空 
间 和 精度 ) ， 优 化 设计 也 仅 能 采取 折 中 ， 而 权重 系数 
的 调整 又 很 难 把 握 。 
优化 设计 的 一 个 替代 方法 是 适当 设计 (appropri- 
ate design) ， 它 不 考虑 最 优化 ， 而 是 确保 期 望 的 性 能 
要 求 都 得 到 满足 。 该 法 的 基础 是 参数 空间 的 概念 ， 空 
间 的 每 一 维 都 与 一 个 设计 参数 相关 联 。 设 计时 依次 考 
虑 每 一 个 性 能 要 求 并 计算 满足 要 求 的 空间 大 小 ， 最 终 
所 得 到 的 设计 方案 就 是 若干 个 空间 的 交集 。 

由 于 制造 总 是 存在 误差 因此 很 难 制造 出 与 靠近 区 
域 边 界 的 值 一 致 的 机 器 人 ， 所 以 实际 操作 中 仅仅 需 

确定 大 概 的 空间 区 域 即 可 。 在 实际 计算 中 ， 区 间 算 法 
已 被 成 功 应 用 于 很 多 不 同 的 应 用 中 必 PS 。 

适当 设计 方法 的 应 用 比 成 本 函数 方法 要 复杂 得 
多 ， 但 它 的 优势 在 于 它 能 够 得 到 所 有 的 可 行 方案 ， 包 
括 考虑 了 制造 误差 进而 能 够 确保 机 器 人 满足 所 有 期 望 
要 求 的 设计 方案 。 


12.10 应 用 实例 
并 联机 构 已 被 成 功用 于 许多 应 用 ， 此 处 将 简介 几 


例 。 近 年 来 几乎 所 有 陆 基 的 天 文 望 远 镜 都 采用 了 并 联 
机 构 ， 要 么 是 用 作 副 镜 校准 系统 (比如 亚利桑那 大 
学 的 MMT 天 文 台 或 者 欧洲 天 文 研究 机 构 (ESO) 设 
于 南半球 的 可 视 与 红外 天 文 观测 望远镜 ( VISTA))， 
要 么 是 用 作 主 镜 的 定向 系统 。1995 年 2 月 执行 STS-63 
任务 的 航天 飞机 中 使 用 了 线 驱动 的 并 联机 器 人 ， 同 时 
有 1 个 八 腿 并 联机 器 人 (具有 八条 支 链 的 并 联机 器 
A) 被 用 于 从 振动 中 分 离 飞 船 的 有 效 载荷 。 美 国 
Motek 公司 开发 的 Caren 计算 机 辅助 康复 系统 也 采用 
了 并 联机 构 。 已 被 所 有 飞行 模拟 器 采用 的 并 联机 构 目 
前 也 被 用 于 开发 驾驶 模拟 器 '*"" 。 在 工业 应 用 方面 ， 
已 设计 出 了 许多 款 并联 加 工 设 备 ， 其 中 的 一 些 还 找到 
了 令 人 满意 的 销售 市 场 (比如 Tricept) ， 可 以 预计 一 
且 设 计 出 了 并 联机 构 专 用 的 控制 器 (目前 并 联机 构 
使 用 的 控制 器 与 串联 机 构 无 异 ， 无 法 充分 发 挥 并 联机 
构 的 潜力 ) ， 则 将 来 必 会 出 现 更 多 的 并 联 加 工 设备 
(尤其 是 高 速 加 工 设 备 ) Physik Instrumente, Micos 
和 Alio 正在 研发 基于 并 联机 构 的 超 精确 定位 设备 。 
在 食品 加 工业 ，S1C- Demaurex 公司 设计 的 Delta 机 器 
人 已 被 广泛 用 于 快速 包装 。 此 外 ，Adept 等 公司 正在 


研发 三 或 四 自由 度 的 高 速 并 联机 器 人 。 
结论 与 扩展 阅读 


本 手册 的 其 他 章节 也 介绍 了 一 些 分 析 并 联机 器 人 
的 方法 : 

1) 运动 学 : 第 1 章 中 介绍 了 运动 学 研究 的 背景 
资料 。 

2) 动力 学 : 第 2 章 介 绍 了 动力 学 计算 的 一 般 方 
法 ， 而 第 14 章 中 则 介绍 了 识别 动力 学 参数 的 方法 。 
3) wit: 第 10 章 介 绍 了 一 整套 设计 方法 。 

4) 控制 : 585. 6 和 7 章 都 谈 到 了 机 器 人 的 控 
制 ， 但 并 联机 器 人 的 闭环 运动 链 导致 其 控制 方案 有 些 
与 众 不 同 。 

必须 强调 的 是 ， 对 很 多 并 联机 器 人 的 算法 来 说 数 
值 分 析 的 效率 是 最 关键 的 。 基 于 Grobner 基 法 、 连 续 
法 以 及 区 间 算 法 来 研究 运动 学 、 作 业 空 间 以 及 奇异 是 
很 有 效 的 。 

有 关 并 联机 器 人 更 多 的 信息 以 及 更 新 的 扩展 参考 
可 在 参考 文献 [12.120, 121] 两 网 站 中 寻找 。 

参考 文献 [12.9, 122, 123] 是 关于 并 联机 器 人 
的 不 错 的 补充 文献 。 

并 联机 器 人 的 应 用 日 益 广泛 ， 正 像 本 手册 的 第 6 
篇 讨论 的 那样 ， 除 了 工业 并 联机 器 人 ， 野 外 并 联机 器 
人 和 服务 并 联机 器 人 也 已 出 现 。 当 然 与 串联 机 器 人 相 
比 ， 并 联机 器 人 的 研究 还 远 未 完善 。 
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具有 和 柔性 元 件 的 机 禹 人 


Alessandro De Luca, Wayne Book 
张 文 增 i$ 


针对 带 有 和 柔性 元 件 的 机 器 人 机 械 臂 ， 无 论 柔 性 
是 集中 于 关节 上 还 是 沿 着 连 杆 分 布 ， 本 章 介绍 其 设 
计 、 动 态 建 模 、 轨 迹 规划 和 反馈 控制 问题 。 因 此 本 
草 分 为 两 个 主要 部 分 。 在 适当 的 地 方 将 指出 两 类 柔 
性 之 间 的 相似 性 或 差异 。 

对 于 带 有 和 柔性 关节 的 机 器 人 ， 本 章 通过 拉 格 时 
日 方法 详细 推导 了 动力 学 模型 ,对 尽量 简化 的 版 本 
进行 了 讨论 。 从 而 可 以 计算 产生 所 需 机 器 人 运动 的 
额定 转 矩 。 通 过 线性 和 非 线 性 反馈 控制 设计 介绍 了 
校准 及 轨迹 跟踪 任务 。 

对 于 带 有 和 柔性 连 杆 的 机 器 人 ， 本 章 分 析 了 用 于 
考虑 分 布 式 柔性 所 需 的 相关 因素 。 针 对 和 柔性 问题 ， 
通过 集中 元 件 、 传 递 矩 阵 或 者 假设 模式 ， 给 出 了 动 
力学 模型 。 接 着 我 们 强调 了 儿 个 具体 问题 ,包括 传 
感 器 的 选择 、 用 于 控制 设计 的 模型 阶 数 ， 以 及 减少 
或 消除 间 拘 性 动作 中 残余 振动 的 有 效 指令 的 生成 。 最 


在 机 峰 人 运动 学 、 动 力学 及 控制 设计 中 的 标准 
假设 是 执行 器 仅 由 刚体 构成 ( 连 杆 及 运动 传递 组 


后 ， 本 章 还 讨论 了 反馈 控制 的 选择 。 


本 章 的 两 个 部 分 中 均 有 一 节 用 于 阐述 原始 文献 
以 及 该 主题 的 扩展 阅读 。 

13.1 具有 柔性 关节 的 机 器 人 pp 228 
13.1.1 动力 学 模型 eee 229 
13.1.2 道 动 力学 eR 233 
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13.1.5 PJER eH 243 

13.2 具有 柔性 连 杆 的 机 器 人 MM 244 
13.2.1 设计 问题 pe 244 
13.2.2 柔性 连 杆 辟 的 建 模 ………………………… 245 
13.2.3 控制 CO E ale aiia e Rr anrea n wi S S Nai « 248 
13.2.4 扩展 阅读 … ee 252 

DIDA EP 252 


机 器 人 ， 我 们 将 讨论 相关 设计 问题 、 动 态 建 模 、 逆 
运动 学 算法 以 及 对 给 定点 调节 的 控制 规律 和 轨迹 跟 


件 ) 。 然 而 ， 这 种 理想 状态 只 在 慢 速 运 动 以 及 较 小 
相互 作用 力 下 才能 被 视 为 成 立 。 实 际 上 ， 机 械 臂 的 
机 械 柔 性 由 两 个 主要 原因 得 以 体现 : 柔顺 传递 元 件 
的 运用 ， 以 及 为 了 减少 移动 连 杆 的 质量 而 采用 的 轻 
型 材料 和 细 长 型 设计 。 这 两 种 柔性 引入 了 驱动 执行 
机 构 的 位 置 和 机 械 臂 末端 执行 器 位 置 之 间 的 静态 和 
动态 挠 度 。 当 我 们 讨论 机 器 人 的 设计 与 控制 时 如 果 
没有 考虑 柔性 ， 我 们 所 能 期 望 的 机 器 人 整体 性 能 将 
会 降低 。 

从 建 模 的 角度 来 看 ， 柔 性 可 以 被 假定 为 集中 在 
机 器 人 关节 上 或 者 〈 以 不 同 的 方式 ) 分 布 在 机 器 人 
的 连 杆 上 。 动 态 建 模 步 又 是 相似 的 ， 在 用 以 描述 机 
器 人 手臂 的 刚体 运 动 的 坐标 之 外 都 需要 引入 额外 的 
广义 坐标 。 然 而 ， 从 控制 的 角度 来 看 ， 所 得 到 的 模 


踪 问 题 。 事 实 上 ， 关 节 和 连 杆 的 柔性 可 能 会 同时 体 
现 出 来 并 产生 动态 交互 。 很 多 已 得 到 的 结果 也 可 以 
扩展 到 这 种 情况 下 。 

在 以 下 的 部 分 ,我们 假定 读者 对 机 器 人 的 运动 
学 、 动 力学 和 刚体 控制 的 一 些 基 本 问题 已 经 有 了 较 好 
的 了 解 (第 1、 第 2 和 第 6 章 )。 


13.1 具有 柔性 关节 的 机 器 人 

在 当前 的 工业 机 器 人 中 ， 关 节 存 在 柔性 是 十 分 常 
见 的 。 在 这 些 工 业 机 器 人 的 传动 /减速 元 件 中 ， 使 用 
皮带 (如 选择 性 柔顺 机 器 人 (SCARA) 家 族 ) ， 长 轴 
(如 UNIMATION 公司 PUMA 机 器 人 ) 、 缆 绳 、 谐 波 减 
速 器 或 摆 线 针 轮 。 这 些 部 件 的 作用 就 是 使 驱动 器 可 以 


型 属性 却 十 分 不 同 。 因 此 ， 在 本 章 中 ， 具 有 和 柔性 关 
节 的 机 器 人 和 具有 和 柔性 连 杆 的 机 器 人 这 两 种 情况 大 
多 是 作为 单独 项 目 分 开 讨 论 的 ， 并 在 适当 之 处 指出 
相似 点 或 者 结构 上 的 不 同 点 。 对 这 两 种 类 别 的 柔性 


布置 在 机 器 人 基 座 附近 ， 从 而 提高 动力 学 效率 ， 或 者 
采用 紧凑 排列 装置 保证 高 减速 比 的 同时 具有 较 好 的 传 
动 效率 。 

然而 当 驱 动力 或 力矩 在 正常 机 器 人 操作 中 增 大 
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时 ， 这 些 零件 本 质 上 是 弹性 的 〈 例 如 谐 波 减速 器 中 
的 柔 轮 ， 见 图 13. 1) ， 它 们 会 在 驱动 器 输出 轴 的 位 置 
和 所 驱动 连 杆 的 位 置 之 间 引入 一 个 时 变 位 移 。 在 没有 
特别 的 控制 行为 的 情况 下 ， 我 们 可 以 观察 到 机 器 人 末 
端 执行 器 在 自由 运动 的 情况 下 会 产生 一 个 振幅 较 小 但 
是 相对 高 频 的 振动 。 男 外 ， 在 一 些 涉 及 与 外 界 环境 接 
触 的 任务 中 也 可 能 会 产生 某 种 形式 的 不 稳定 〈 如 卡 
WE EU) 。 


波形 发 生 器 ES 


图 13. 1 谐 波 减速 器 的 组 成 


最 近 ， 和 柔性 驱动 /传动 元 件 被 特意 选用 于 机 器 人 
中 ， 以 适用 于 物理 人 机 交互 。 事 实 上 ， 这 种 形式 的 机 
械 柔 顺 性 保证 了 传动 装置 与 (可 能 的 话 ， 轻 质量 ) 
连 杆 之 间 的 惯性 解 耦 ， 从 而 减少 了 与 人 类 意外 碰撞 时 
的 动能 。 这 样 一 种 旨 在 安全 的 机 械 设计 应 该 有 一 种 更 
为 复杂 的 控制 设计 来 进行 平衡 ， 以 达到 保证 刚性 机 器 
人 在 速度 及 末端 执行 器 运动 精度 两 方面 性 能 的 要 求 
(第 57 章 ) 。 
图 13. 2 和 图 13.3 展示 了 两 例 具 有 柔性 关节 的 
HLR, BR (8 个 旋转 关节 ) 机 器 人 Dexter 与 7R 
轻型 机 械 辟 DLR LWR- 亚 。 第 一 个 机 器 人 中 ,第 3 ~ 
第 8 个 电动 机 布置 在 第 二 连 杆 中 ， 通 过 钢 缆 及 滑轮 
将 运动 传递 到 末端 。 第 二 个 机 器 人 具有 模块 化 结构 ， 
每 个 电动 机 整合 在 相关 关节 中 ， 并 用 一 个 谐 波 传动 
装置 传动 。Dexter 机 器 人 的 关节 刚度 根据 关节 的 不 
[E] 120N + m/rad 至 6300N + m/rad 变化 ， 而 DLR 
LWR- 亚 机 械 臂 的 范围 为 6000 ~ 15000N - m/rad, 3X 
些 数值 都 与 减速 齿轮 传动 后 的 挠 度 和 相关 扭矩 的 评 
估 有 关 。 

柔性 传动 元 件 的 挠 度 可 以 被 建 模 成 集中 于 机 器 人 
关节 上 ， 从 而 降低 相关 运动 方程 的 复杂 性 。 和 刚体 情 
况 相 比 ， 具 有 和 柔性 关节 ( 和 刚性 连 杆 ) 的 机 器 人 的 
动力 学 模型 需要 的 广义 坐标 数量 是 完全 确定 特征 量 的 
刚性 体 (电动 机 及 连 杆 ) 的 两 倍 。 


fy 


图 13.2 Scienzia Machinale 的 缆绳 驱动 机 器 人 Dexter 


综 上 所 述 ， 具 有 柔性 关节 的 机 器 人 是 一 种 控制 输 
入 的 数量 严格 小 于 机 械 自由 度 的 数量 的 实例 。 这 表明 
了 和 柔性 机 器 人 实现 标准 运动 任务 的 控制 方案 设计 要 远 
比 刚性 机 器 人 困难 得 多 。 此 外 ， 完 成 完整 的 状态 反馈 
法 则 需要 两 倍数 量 的 传感器 用 来 测量 关节 变形 前 后 
(或 过 程 中 ) 的 参量 。 另 一 方面 ， 用 于 控制 机 器 人 的 
电动 机 转 抢 与 由 于 关节 柔性 引起 的 扰动 力矩 作用 在 同 
一 个 关节 轴 上 (它们 物理 上 是 并 列 的 ) 。 值 得 注意 的 
是 ， 这 是 一 个 与 分 布 在 连 杆 上 的 柔性 所 不 同 的 情况 。 
这 个 特性 十 分 有 利于 消除 振动 以 及 控制 整个 机 器 人 的 
运动 。 大 概 来 说 ， 我 们 将 能 够 使 用 输入 指令 通过 在 柔 
性 源 之 前 动作 ， 以 达到 确保 那些 定义 在 期 望 的 柔性 行 
为 之 上 的 输出 变量 。 
13.1.1 动力 学 模型 

明确 包含 了 弹性 关节 的 动力 学 模型 被 用 以 定量 评 
佑 刚体 运动 的 振动 效应 、 验 证 刚性 关节 假设 下 的 控制 
法 则 是 否 仍然 适用 于 实际 情况 (或 其 应 该 被 修正 到 
什么 程度 ) ， 并 使 得 设计 新 的 基于 模型 的 前 馈 和 反馈 
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图 13.3 德国 宇航 中 心 的 轻型 机 械 臂 DLR LWR- M 


控制 器 成 为 可 能 。 

我 们 可 以 将 一 个 含有 和 柔性 关节 的 机 器 人 看 作 是 由 
N+1 个 刚体 组 成 的 开放 运动 链 : 基 座 以 及 NN 个 连 杆 ， 
由 六 个 发 生 了 变形 的 〈 旋 转 的 或 平移 的 ) 关节 互相 
连接 , 并 由 N 个 电动 机 驱动 。 从 机 械 的 角度 来 看 ， 
每 一 个 电动 机 (包括 其 定子 和 转子 ) 都 是 一 个 具有 
惯性 特性 的 附加 刚体 。 尽 管 由 于 不 同 传动 装置 的 运用 
可 能 会 遇 到 混合 情况 ,我 们 仍 将 所 有 的 关节 视 为 柔性 
的 。 当 减速 齿轮 组 存在 时 ， 它 们 被 建 模 在 位 于 关节 变 
形 发 生 之 前 。 从 而 可 以 得 到 如 下 标准 假设 。 

Al. 关节 变形 小 ， 因 而 柔性 作用 仅 限于 线性 弹 
性 域 。 

A2. 驱动 器 的 转子 被 建 模 为 质心 位 于 旋转 轴 上 的 
统一 整体 。 

A3. 每 个 电动 机 都 位 于 机 器 人 臂 上 所 驱动 的 连 杆 
之 前 。( 这 可 以 被 推广 到 多 个 电动 机 同时 驱动 多 个 末 
端 连 杆 的 情况 。) 

第 一 个 假设 支持 具有 和 柔性 关节 机 器 人 的 术语 ， 这 
些 术语 在 文献 中 经 常 被 用 到 。 关 节 i 处 的 弹性 被 建 模 
为 一 个 刚度 系数 天 >0 的 弹簧 ， 对 旋转 关节 为 扭转 弹 
簧 ， 而 对 于 平移 关节 为 线性 弹簧 。 图 13.4 显示 了 一 
个 由 电动 机 通过 旋转 柔性 关节 驱动 的 独立 连 杆 。 和 柔性 


关节 的 非 线 性 刚度 特性 也 可 以 被 考虑 进来 ， 如 果 从 挠 
度 到 力 之 间 映 射 是 光滑 和 可 逆 的 话 。A2 这 条 假设 是 
电动 机 长 久 使 用 的 一 项 基本 要 求 ， 因 此 是 非常 合理 
的 。 正 如 我 们 将 看 到 的 ， 这 意味 着 机 器 人 动力 学 模型 
中 的 惯性 矩阵 和 重力 项 与 电动 机 转角 位 置 是 相互 独立 
的 。 图 13.5 展示 了 一 个 满足 假设 A3 的 典型 电动 机 布 
置 例子 。 最 简单 的 情况 是 : 第 i 个 电动 机 连接 在 第 i- 1 
个 连 杆 上 ,通过 i-1 连 杆 与 第 i 个 连 杆 相连 的 轴 了 驱动 
第 ; 个 连 杆 。 例 如 LWR- 亚 的 机 械 臂 就 是 这 种 情况 。 
这 种 电动 机 沿 着 结构 的 错位 布置 对 运动 的 动力 学 方程 
的 结构 具有 很 大 影响 。 


Ty 
me 


图 13.4 弹性 关节 示意 图 


图 13.5 开 式 运动 链 中 电动 机 和 连 杆 的 布置 


为 了 运动 学 和 动力 学 分 析 ，2NN 个 坐标 系 被 固 接 
在 机 器 人 链 中 的 2N 个 运动 刚体 上 ( 连 杆 和 电动 机 ): 
连 杆 坐标 系 L 和 电动 机 坐标 系 R， 其 中 i=1, 2…N 
( 见 图 13.5)。 为 了 定义 连 杆 坐标 系 L;， 可 以 使 用 标 
YE Denavit- Hartenberg 约定 方法 。 坐 标 系 R, 被 固 接 在 
电动 机 的 定子 上 ， 与 电动 机 的 对 称 轴 对 齐 ， 带 有 一 个 
沿 着 转子 旋转 方向 的 z 轴 。 

相应 地 ， 需 要 定义 2N 个 广义 坐标 。 下 式 给 出 了 
一 组 可 能 的 坐标 集合 : 


O= MES 
0 


AF, q 是 连 杆 位 置 的 Y 维 矢量 ; 0 是 电动 机 ( 即 转 
F) 位 置 的 W 维 矢量 ， 它 可 通过 传动 /减速 齿轮 箱 的 
情况 反映 出 来 。 这 组 变量 的 选择 非常 方便 ， 因 为 : 
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1) 该 模型 形式 上 与 减速 比 相互 独立 。 

2) 这 些 位 置 变 量 有 一 个 相似 的 动态 范围 。 

3) 该 机 器 人 的 运动 学 将 仅 是 连 杆 变量 4 (这 些 
变量 已 经 超出 了 关节 和 柔性) 的 一 个 函数 ， 从 而 与 机 
器 人 正 / 逆 运动 学 相关 的 所 有 问题 都 和 全 刚性 机 器 人 
的 情况 相同 。 

对 于 一 些 问题 ， 定 义 变量 9。( 即 减速 前 电动 机 
位 置 的 W 维 矢量 ) 是 很 有 用 的 ， 这 些 数据 可 以 由 安 
装 在 电动 机 上 的 编码 器 直接 测量 得 到 。 在 电动 机 被 直 
接 放置 在 第 ;个 关节 轴 上 的 情况 下 ， 我 们 可 以 得 到 
9,;-nj0,, HA nizl1 为 第 i 个 关节 的 减速 比 。 另 
外 ， 当 i = 1，…，N 时 ,不同 之 处 5 =q; - 0, 是 在 
Pi PATRE, Mi = K,(0,-9,) 是 通过 相应 
弹簧 ( 见 图 13.4) 传递 到 第 i 个 连 杆 的 转 矩 一 一 其 
值 由 各 处 的 关节 力矩 传感器 测量 得 到 。 注 意 ， 对 于 具 
有 和 柔性 连 杆 的 机 器 人 ， 集 合 (0, 6) 通常 被 用 在 动 
态 建 模 中 ， 其 中 8 是 连 杆 挠 度 坐 标的 矢量 。 

根据 拉 格 朗 日 方法 ,下面 将 推导 得 出 影响 拉 格 朗 


HH Z- 70,0) -%(O) 的 唯一 能 量 。 

该 机 器 人 的 势能 由 重力 势能 和 关节 弹性 势能 组 
成 。 重 力 势 能 部 分 与 连 杆 的 质心 (m,) 位 置 和 电动 
机 的 质心 (m,) 位 置 有 关 。 由 于 假设 A2 ， 电 动机 质 
心 位 置 与 0 无 关 ， 因 此 

W gray = Parav tin C00 + era mor Cd) 
对 于 可 能 的 弹性 部 分 ， 由 于 假设 Al ， 我 们 有 


1 " 
Man oy (4 70) K( -0) 


K - diag( K, +- , Ky) 
由 上 可 得 : A(O) = Vau (GQ) + "aq -0) 
该 机 器 人 的 动能 是 连 杆 和 电动 机 转子 动能 的 总 
和 。 对 于 连 杆 ， 计 算 方法 和 标准 的 刚性 机 器 人 的 情况 
没有 区 别 ， 它 完全 可 以 写成 一 般 形 式 : 


m ] 
Fin 7d M.(q)4 


z 


(13. 1) 


SUP, M, (q) 为 连 杆 惯性 的 正定 对 称 和 矩阵 。 对 于 转 
子 来 说 ， 还 需要 一 些 详细 说 明 . 
Fane = D Ae, 
= Y ( 3 MDiv | $e; Lu, | 
(13.2) 


Ri i 
L; = diag (Lin, da La), 


UB, La 7L, E v; 可 以 被 表达 成 只 包含 gq Mq 
两 个 变量 的 函数 。 此 外 ， 由 于 假设 A3， 第 i 个 转子 
的 角速度 一 般 可 表示 为 


oye (13.3) 
j=l Öp 

RP, Jala) ERE EEP ; 列 ， 它 将 机 器 

人 链 中 的 连 杆 速度 4 与 第 i 个 转子 的 角速度 联系 了 起 

来 。 通 过 将 式 (13.3) RAR (13.2) H, HH 0, 

用 0 表示 ， 它 可 以 被 写成 


Aus ord "(My GD *S() B^'S (9) d + 


grs(00 + 了 0rB6 


式 中 ,B 是 包含 了 转子 转轴 周围 的 惯性 部 分 1 的 一 
个 常数 对 角 惯 性 矩阵; Mel) 包含 了 转子 质量 (也 
可 能 包含 了 绕 其 他 主轴 的 转子 惯性 部 分 ) ， 而 且 方 阵 
S(q) 表示 转子 和 之 前 的 机 器 人 链 中 连 杆 的 惯性 耦合 
关系 。 

一 个 简单 的 例子 阐明 了 式 (13.4). 中 的 推导 及 
其 实例 。 我 们 的 讨论 也 包括 了 减速 元 件 以 说 明 转 轴 周 
围 的 转子 惯性 组 件 在 不 同 减 速 比 情况 下 的 动能 变化 。 
我 们 考虑 一 个 具有 两 个 转动 柔性 关节 的 平面 机 器 人 ， 


(13.4) 


其 中 第 一 个 连 杆 长 度 为 4， 并 且 电 动机 直接 安装 在 关 
节 轴 上 。 两 个 转子 的 动能 是 ; 
Am IDE 1 = 1,183 


1 . 1 . k 2 
p = ERAT] i T PEL (qi +0 na) 


1 .2 1 z m. > 
=-m,^iqi ur (gi +2n,q,0, +n203) 


2 
从 而 得 到 
0 | C Ed 
B- A S = 
0 Ln 0 0 
n (^ a: sos (^ o) 
0 0 0 0 
EARR F, EES (以 及 M,) EAEE, EE 


Ek, IAIL n, AREE B 给 出 了 由 转子 引起 的 主 
要 惯性 效果 。 并 且 ， 如 果 第 二 个 电动 机 被 安装 在 远离 


式 中 ,vw 是 第 i 个 转子 质心 位 置 的 线 速度 mw, 是 第 i 
个 转子 的 角速度 。 式 (13.2) 中 所 有 角度 方面 的 量 
都 可 以 在 本 地 坐标 系 R 中 很 容易 地 表达 出 来 。 根 据 
假设 A2 ， 可 知 转子 的 惯性 矩阵 是 对 角 阵 


第 一 个 关节 处 (这 常常 是 SCARA 机 械 辟 这 类 情况 )， 
或 者 虽然 仍 非常 接近 第 二 个 关节 ， 但 旋转 轴 正 交 于 该 
关节 轴 ， 那 么 矩阵 $ 将 为 零 。 

一 般 来 说 ， 作 为 A3 假设 的 结果 ， 和 矩阵 $S(q) 常 
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会 有 一 个 严格 的 上 三 角 结 构 ， 并 且 其 非 零 项 是 级 联 相 
关 的 : 


S(q) = 

0 55 55(q5) Sig (42 593) 7 Siy (42 7d 21) 

0 0 S5 Sa (3) Soy (93 5°77. dy-1) 

00 0 Say Ss (dada) 

0 0 0 0 Sy .5 v1. Sy2, v (d 1) 

0 0 0 e 0 0 Sian 

0 0 0 e 0 0 0 
(13.5) 


综 上 所 述 ， 该 机 器 人 的 总 动能 


F= +6" 4 0)0 


M S ] 
lq LE ee T 
S (q) B 0 
M, (4) +M (q) *S(q)B ' S'(q) 
(13.6) 
正如 预期 的 那样 ， 机 器 人 的 总 惯性 矩阵 M 只 依赖 
于 qo 
利用 拉 格 朗 日 方程 得 到 最 终 完整 的 动力 学 模型 


p T c(q.d ) +c (qd 0) E 
S(q B Áo e, (4,4) 


式 中 , M(q) = 


pee) 
7 (13.8) 
F,0 -D(0 -q ) 
xp, HAEE F, FID 分别 对 应 包含 了 连 
杆 部 分 黏 性 系数 、 电 动机 部 分 黏 性 系数 和 关节 处 的 弹 
簧 阻尼 。 同 时 ， 更 一 般 情况 下 的 非 线 性 摩擦 力 Tr 也 
应 该 被 考虑 。 我 们 应 当 注 意 到 ， 在 原则 上 ， 通 过 选择 
合适 的 控制 力矩 Tr， 可 以 使 得 作用 在 电机 上 的 摩擦 力 
得 到 完全 抵消 ， 然 而 由 于 不 对 齐 的 原因 ， 这 样 的 方式 
不 能 消除 连 杆 部 分 的 摩擦 作用 。 
1. 模型 性 质 
在 式 (13.7) 中 ， 有 关 速 度 的 2N 维 向 量 cu(@， 


O) 中 的 所 有 元 素 均 和 电动 机 的 位 置 636, N 维 向 
fe, e, 和 cs 中 的 具体 相关 量 都 遵循 基于 克 里 斯 托 
尔 符号 c, 元 素 的 一 般 表 达 式 ，: 


d -l6 AG 


式 中 ， i=l, 2--- ,2N; Mb; No M(@) 
B958 i FI]. RUE. 速度 矢量 c 和 c, 中 包 
含 从 年 阵 $S(qg) 得 到 的 一 些 变量 。 计 算 结果 表明 : 
1) e, 向 量 不 包含 4 、0 中 的 二 次 速度 项 ， 仅 包 
含 0,4, 中 的 量 。 
2) 当 和 矩阵 5S 是 常数 时 ，c, Me, 便 均 为 0。 
动力 学 模型 (13.7) 也 符合 刚体 模型 情况 下 的 
一 些 特 性 ， 例 如 : 
1) 在 一 组 合适 的 动态 系数 情况 下 ， 模 型 方程 组 


s 


g(q)*K(q-0)| (0 
K(8 - q) e) ene 
式 中 ， 惯 性 项 〈 与 总 惯性 矩阵 M(q) 相关 ) 、 科 式 力 


和 离心 力 〈 统 一 表达 为 cu(9@，@) ) 和 潜在 项 (9% 
(0)/90)' 已 被 分 开 表达 。 特 别 要 指出 的 是 g(q) = 
(OW (9)/0q)"， 而 Ty =K(O-q) 是 通过 关节 传 
递 的 柔性 扭矩 。 

前 YX 个 和 最 后 N 个 动力 学 模型 方程 (13.7) 分 
别 对 应 了 连 杆 和 电动 机 方程 组 。 

式 (13.7) 右边 ， 所 有 非 保 守 广 义 力 都 应 该 有 
所 体现 。 当 不 考虑 能 量 耗 散 影 响 时 ， 电 动机 方程 组 中 
只 描述 了 电动 机 转 矩 T 对 0 所 做 的 功 ( 即 经 过 减速 比 
平方 放大 后 作用 在 电动 机 输出 轴 上 的 转 矩 ) 。 如 果 机 
器 人 的 末端 执行 器 与 环境 相互 作用 ， 则 连 杆 方程 组 右 
边 的 零 应 改 为 rss 2J (q) F, HP I (gq) 是 机 器 人 雅 
PJ HEERE; F 是 环境 作用 于 机 器 人 上 的 力 / 转 矩 。 

在 能 量 耗 散 效 果 存 在 的 情况 下 , R (13.7) 的 
右边 增添 了 附加 项 。 例 如 ， 变 速 器 两 侧 的 黏 性 摩擦 和 
(AGRE) 柔性 关节 上 弹 短 的 阻尼 会 产生 矢量 


满足 一 个 线性 的 参数 化 过 程 ， 包 括 关 节 刚 度 和 电动 机 
惯性 ， 这 些 对 于 模型 辨识 和 自 适应 控制 都 是 有 益 的 。 


2) 科 式 力 和 离心 力 总 可 以 分 解 为 c,(@,O) = 


£(0, 8)8， 用 这 种 方法 ， LL - 2c S XE 
称 的 ， 该 属性 可 被 应 用 于 控制 分 析 。 


3) 对 于 只 有 旋转 关节 的 机 器 人 ， 重 力 矢 量 g(9) 
的 斜率 总 体 上 乘 一 个 常数 是 有 界 的 。 


4) 最 后 ， 当 关节 刚度 极 大 时 (K 趋向 于 正 无 
穷 )， 则 9 趋向 于 gq， JF Hn 趋向 于 Tt。 很 容易 验证 动 
力学 模型 (13.7) 在 该 限定 条 件 下 ， 转 化 为 全 刚性 
机 器 人 (包括 连 杆 和 电动 机 ) 的 标准 模型 。 

2. 简化 模型 

通常 ， 连 杆 和 电动 机 方程 组 (13. 不 仅 通过 
关节 处 的 弹性 扭矩 Ta 实现 动态 耦合 ， 还 (在 加 速度 
通过 和 矩阵 S(q) 中 的 惯 性 项 进 了 耦合 一 一 通 

一 种 低能 量 转移 路 径 。 这 些 惯 性 耦合 的 存在 和 实 
| 臂 的 运动 学 布置 ， 尤 其 是 电动 机 和 
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传动 装置 的 具体 位 置 安排 。 在 某 些 情况 下 ， 和 矩阵 S 是 
常数 矩阵 〈 例 如 前 例 中 带 有 任意 连 杆 数 的 平面 情况 ) 
或 零 矩 阵 (例如 带 有 和 柔性 关节 的 独立 连 杆 ,或 拥有 
N =2 个 连 杆 、 两 关节 轴 正 交 并 且 电 动机 布置 在 关节 
处 的 机 器 人 ) 。 因 此 将 大 大 简化 其 动力 学 方程 。 

对 于 具有 和 柔性 关节 的 一 般 机 器 人 ， 我 们 可 以 利用 
大 减速 比 (n, 29 100 ~150) ， 同 时 简单 的 忽略 连 杆 和 
电动 机 之 间 由 于 惯性 耦合 引起 的 能 量变 化 〈 再 次 参 
见 2R 平 面 的 例子 )。 这 相当 于 考虑 以 下 简化 假设 : 
A4. 转子 的 角速度 只 受 其 自转 的 影响 ， 即 . 


Fiw, = (0 0 RS i=1, =, N 
取代 式 (13.3) 的 完全 形式 。 
因此 ,转子 的 总 角 动 能 仅 为 了 0"B0 (或 $=0)， 则 
动力 学 模型 (13.7) 可 简化 为 

M(q) 4 *c(q,q) *g(q) +K(g -0) =0 

BO «K(0-q)-T (13.9) 

XP, M(q) =M,(q) +Mar(q)。 这 个 模型 的 主要 特 
点 是 连 杆 和 电动 机 方程 仅 通 过 弹性 转 矩 T; 进行 动态 
耦合 。 此 外 ， 电 动机 方程 组 完全 线性 化 。 

我 们 注意 到 完整 模型 (13.7) 和 简化 模型 
(13.9) 表现 出 了 相应 于 不 同 控制 问题 的 不 同 特点 。 
事实 上 ， 简 化 模型 总 能 由 静态 反馈 使 反馈 线性 化 ， 然 
而 只 要 耦合 参数 $ 震 0， 对 于 完整 模型 来 说 这 种 线性 
化 永远 无 法 成 立 。 

3. 奇异 摄 动 模型 

模型 中 的 一 个 有 趣 的 现象 是 存在 两 个 时 间 标 度 的 
动态 行为 ， 这 是 在 柔性 关节 的 机 器 人 的 关节 刚度 K 
相对 较 大 但 仍 有 限 的 情况 下 产生 的 。 这 种 行为 可 由 一 
个 简单 的 坐标 线性 变换 前 明 ， 即 以 关节 力矩 嫉 取代 
0。 为 简单 起 见 ， 只 举 简化 模型 (无 耗 散 ) 为 例 。 

由 于 关节 刚度 的 对 角 和 矩阵 被 假定 为 具有 很 大 但 相 
似 的 元 素 ， 普 通 公 因子 1/8 >> 1 可 以 被 提取 为 

K-LK- Bdiag (K,, Ut, Ky) 
然后 由 连 杆 方程 组 给 出 了 慢 速 子 系统 ， 它 们 被 改写 为 
M(q) 4 *c(q,.q) *g(q) - y. (13.10) 
为 了 得 到 快速 子 系统 的 动力 学 模型 ， 我 们 将 关节 转 矩 
二 次 微分 ， 电 动机 和 连 杆 加 速度 由 式 (13.9) RA, 
同时 还 用 到 了 上 述 定义 的 K。 从 而 得 到 


^ 


e t,-KIB'T-[B' «M (q)] T+ 


M'(q)ce(qeq)*g(q)]] X (13.11) 
对 于 小 的 e, XX (13.10) 和 式 (13.11) 描述 了 一 个 


奇异 摄 动 系统 。 两 个 分 别 作用 在 慢 速 和 快速 动态 中 的 
时 间 坐 标 为 上 和 o =t/e， 因 为 
et =e d 五 -于 a 
dt da 
这 个 模型 是 复合 控制 方案 的 基础 ， 其 中 控制 转 矩 的 一 
般 形 式 为 
T- T.(q,d ,t) *eti(q,q , T;, T) (13.12) 
这 包括 了 一 个 在 忽略 关节 弹性 的 条 件 下 得 到 的 缓慢 作 
用 量 Tt， 以 及 一 个 将 状态 空间 中 快速 柔性 动态 达到 局 
部 稳定 的 附加 作用 量 tr。 我 们 可 以 验证 ， 当 式 
(13.10)、 式 (13.11) 和 式 (13.12) 中 e=0 时， 等 
效 刚体 机 器 人 模型 便 恢复 为 
[M(g) +B]q *c(q,q) +8(q) = 下 
具有 和 柔性 连 杆 的 机 器 人 执行 器 也 可 以 推导 出 类 似 的 奇 
异 摄 动 模型 ( 和 控制 设计 )。 


13.1.2 逆 动 力学 


给 定 一 个 机 器 人 的 期 望 运动 ， 我 们 希望 计算 出 在 
理想 条 件 下 精确 重 现 这 个 运动 所 需 的 额定 转 矩 OA 
动力 学 问题 ) 。 该 额定 转 矩 可 被 用 做 轨迹 跟踪 控制 律 
中 的 一 个 前 馈 项 。 

对 于 刚性 机 器 人 来 说 ， 逆 动力 学 是 一 个 通过 在 动 
态 模型 中 用 广义 坐标 替代 期 望 运动 所 获得 的 简明 代数 
运算 。 为 了 达到 精确 重 现 该 运动 的 最 低 要 求 ， 设 计 的 
运动 有 连续 可 微 的 期 望 速度 。 对 于 带 有 柔性 关节 的 机 
器 人 来 说 ， 适 动 任务 可 以 通过 一 个 期 望 的 连 杆 轨迹 项 
q-4,0) 来 方便 地 表达 (可 能 从 笛 卡 儿 空 间 中 一 个 
期 望 运动 的 运动 学 道 解 而 求 得 ) 。 附 加 的 复杂 性 在 于 
这 样 的 事实 ， 并 非 所 有 的 机 器 人 坐标 都 可 以 用 这 种 方 
式 直接 给 定 ， 因 此 我 们 需要 更 多 的 推导 。 这 将 要 求 期 
望 轨迹 g(t) e [0,7]) 有 更 高 的 平滑 度 ， 其 中 最 终 
时 间 耻 可 能 是 有 限 的 ， 也 可 能 不 是 。 

1. 简化 模型 

首先 考虑 简化 模型 (13.7), OUT ES, A n(q, 
4 ) =c(q,4 ) +8(4g)。 在 期 望 连 杆 运 动 上 考察 连 杆 
方程 


A 


M(q,) 4, tn(q4.q,) + Kq,-K0, (13.13) 
与 期 望 连 杆 运动 相关 的 电动 机 的 额定 位 置 9, 很 容 
易 获 得 。 在 关节 处 的 额定 弹性 转 矩 为 TI =K(0, -gq )， 
(注意 ， 从 式 (13.13) 中 看 出 ， 这 个 量 可 以 表示 为 
一 个 关于 qu, q,0 4, 的 函数 ， 它 与 K 是 无 关 的 )。 
XX (13.13) 进行 微分 得 到 电动 机 额定 速度 9, 的 表 
Xx. 
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M(q,)qj +M(q,) qa +n (qasqa) +Kq, -K0, 
(13. 14) 

其 中 用 到 了 符号 y = diy/dt'。 再 次 进行 微分 ,我 们 
得 到 

M(gqi) qs +2M(q,)q\° + n(q,.d)) + 
[M(q,) +K] 4, - K6, (13. 15) 
该 式 被 用 于 沿 着 期 望 运动 所 评估 的 电动 机 方程 中 。 简 
化 后 ， 得 到 额定 转 矩 

Ti = [M(q,) +B) q, *n(q,.4,) +BK`' 


{M(q,) gi" +2M (qa) + 天 (gu gd) + 


M(q,) +Kq| (13. 16) 
其 中 可 以 清楚 地 看 到 相对 于 刚性 情况 下 的 额定 转 矩 ， 
由 于 关节 的 柔性 而 有 附加 项 存在 于 式 中 。 对 环 的 赋 
值 涉及 动力 学 模型 的 一 阶 和 二 阶 偏 导数 的 计算 。 例 
如 ， 我 们 需要 计算 
M[q4Q)] = 之 us KL 
RP, e 是 第 ;个 单位 矢量 ， 它 和 其 他 类 似 表达 式 可 
以 通过 符号 运算 软件 获得 。 从 式 (13.16). 可 以 得 出 
结论 ， 精 确 重 现 期 望 运 动 的 最 低 要 求 是 gq,(1) 保证 
连续 可 微 (HU, qi (0). 在 时 间 区 间 [0, T] 内 存 
在 )。 从 系统 的 柔性 特性 来 看 ， 这 样 一 个 较 高 的 平滑 
性 要 求 并 不 难保 证 。 
2. 完整 模型 
模型 (13.9) 还 需要 进一步 分 析 。 为 了 便于 论 
述 ， 并 不 失 一 般 性 ， 对 一 个 常数 矩阵 S 进行 考虑 。 当 
评估 所 期 望 的 连 杆 运动 的 运动 方程 
M(4,) 44 +80, * n(q4,d4) * Kq, - K0, 
(13.17) 
时 ， 左 侧 的 电动 机 额外 加 速度 使 得 电动 机 位 置 9, 不 
能 被 直接 表达 为 一 个 只 以 (gq,，g4，44) 为 自 变 量 
的 函数 。 但 是 ， 如 式 (13.5) 所 示 的 具有 严格 上 三 
角 结 构 的 和 矩阵 $ 定义 了 一 个 0, 的 分 量 ， 其 利用 标量 
方程 (13.17) 进行 递归 。 事 实 上 ,第 NN 个 方程 关于 


0 , 是 独立 的 ， 


Dod 


M(t) qa +0" 0, * ny(q4.4,) tK, 7 K40,. 
因此 ， 该 等 式 可 用 于 定义 
Ay =fy (a sda (d) 
经 过 两 次 微分 后 ， 其 二 次 时 间 导 数 为 


Oan fx sda yt** a ) 


在 第 (N-1) 个 方程 中 


My. (44) Ga + Siwy ay + Ryn (qu sda) + 
Ky, aqaa -K, 404. 
加 速度 0, ,在 之 前 步骤 中 已 被 确定 。 因 此 ， 该 方程 
可 类 似 的 用 于 定义 
8, v1 2 fv (dasqa , egi ) 
经 过 两 次 微分 ， 同 样 可 得 


By ver =f% Garda) 
请 注意 每 当 Sy_,w =0 F, gy X T Oy. 导数 的 最 高 
阶 数 便 没 有 增加 。 这 个 结论 也 适用 于 递归 以 下 步骤 。 
从 连 杆 方 程 组 的 最 后 一 项 开始 向 后 兴 代 ， 标 量 计 算 最 
后 得 到 如 下 定义 

baa = (Ga sqa I UU ) 
和 


as... : [2(N+1)] 
04, Sfi GaGa uns) 


可 见 其 与 g, 所 能 进行 的 最 高 微分 阶 数 有 关 。 用 这 种 
计算 方式 算得 的 6, =f" (C, ， 额 定 转 矩 最 终 可 由 电 
动机 方程 组 计算 得 到 ， 同 时 可 以 对 比 期 望 运动 来 进行 
评价 。 将 式 (13.17) BUCK (0, -gq,)， 得 到 

Ti = [M(q,) +S"] d, *n(q4.d,) + 


(B*S)0,(4,,.,,7,4,  ) (13.18) 
因此 ， 电 动机 - 连 杆 惯性 耦合 的 存在 大 大 增加 了 求解 
该 道 运动 学 问题 的 复杂 性 。 为 了 精确 再 现 式 
(13.18) 中 额定 转 矩 所 对 应 的 所 需 连 杆 轨迹 ，gu (1) 
需要 满足 (2N +1) 阶 连续 可 微 ， 即 g?"”*? 在 时 间 
区 间 [0, T] 上 存在 。 

最 后 我 们 注意 到 ， 能 否 将 系统 状态 和 输入 量 的 发 
展 用 代数 方法 表达 ， 其 可 能 性 取决 于 所 谓 的 平滑 特 
性 ， 此 代数 表达 式 是 通过 对 输出 变量 〈( 即 本 例 中 的 
q) 和 其 微分 后 的 有 限量 的 分 析 而 得 。 以 上 的 逆 动 力 
学 分 析 表 明 ，g 是 具有 和 柔性 关节 机 器 人 模型 (无论 用 
式 (13.7) 或 式 (13.9) ) 的 一 个 平 特性 输出 。 

还 要 注意 的 是 当 gu 被 视 为 常数 时 ， 这 些 计算 都 
对 相关 电动 机 位 置 提供 了 相同 的 条 件 
0,-4, *K'g(q) 


(13.19) 


和 额定 静态 转 矩 
Ti - g(q,) (13.20) 
3. 存在 的 耗 散 项 
在 逆 动 力学 中 引入 耗 散 项 后 ， 我 们 需要 一 些 补充 
条 件 。 传 输 过 程 中 作用 于 电动 机 侧 的 任何 模型 的 摩擦 
效应 都 无 需 引 入 额外 条 件 进 行 计 算 。 然 而 连 杆 侧 的 摩 
擦 则 需要 一 个 平滑 模型 来 描述 ， 因 为 需要 对 连 杆 方程 
进行 微分 。 因 此 ,在 式 (13.13) 或 式 (13.17) 引 
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人 之前, 我们 需要 考虑 一 些 近 似 函 数 ( 如 用 双 
切 函 数 取 代 不 连续 符号 函数 ) 。 

另 一 方面 ， 不 可 忽视 的 弹 敌 阻尼 忆 式 (13.8) 
的 存在 改变 了 计算 结构 。 虽 然 这 降低 了 gy 的 微分 阶 
数 ， 但 这 个 问题 将 变 为 非 代数 的 ; 事实 上 ， 逆 系统 需 
要 利用 动态 系统 的 解 ， 虽 然 只 是 简单 的 一 个 。 

例如 考虑 模型 (13.9) ， 包 括 式 (13.8) 给 出 的 
所 有 的 耗 散 项 。 当 评估 连 杆 方程 


M(q,) 4, *n(q,,4,) +(D * F)q, * 


地 
EJ 


Kq, = DO, + K0, 


电动 机 速度 0, 也 同时 出 现在 了 等 式 右边 。 对 式 
(13. 12) 微分 得 到 


(13.21) 


D0, + KO, =w, (13. 22) 
和 
wy =M(qu) qi +[M(q,) +D+F,] da + 
n (qasqa) * Kq, 
Ji& (13.22) 是 一 个 由 状态 量 9, 和 力 的 信号 wi(1) 
构成 的 一 阶 线性 渐进 稳定 的 动态 系统 (内 部 动态 ) 。 


对 于 一 个 给 定 的 g,(0) ， 我 们 需要 用 方程 的 解 9,(1) 
及 其 相关 微分 0,00). 来 计算 电动 机 方程 组 中 的 额定 
转 矩 。 这 就 产生 了 

Ti - M(q,) d. *n(q,,4,) +F qa +B0, +F,0, 


其 中 式 (13.21) 已 被 用 来 取代 D(0,-g,) +K(0, 


决 ， 从 而 能 得 到 一 个 适合 的 解 。 
13.1.3 调节 控制 


我 们 接着 考虑 以 下 问题 : 控制 具 有 弹性 关节 的 机 
器 人 运动 使 其 达到 一 个 固定 的 形态 。 在 这 个 问题 中 ， 
没有 涉及 轨迹 规划 ， 但 应 该 建立 一 种 反馈 法 则 ， 以 达 
到 一 种 理想 的 闭环 平衡 的 渐进 稳定 。 优 先 考虑 广义 
解 ， 即 从 任意 初始 状态 开始 便 有 效 的 量 。 

根据 上 一 节 的 分 析 ， 显 然 ， 只 需要 对 连 杆 坐 标定 
义 唯一 常量 gu(G4(1) =0) ER (13.19) 中 ,一 个 
电动 机 的 唯一 参考 变量 9, 其 实 是 与 期 望 的 g, 相关 的 
(反之 , 其 可 能 会 导致 机 器 人 末端 执行 器 的 理想 次 
态 ) 。 此 外 ， 式 (13.20) 给 出 了 任何 合适 的 控制 器 
所 提供 的 达到 稳定 状态 所 需 的 静态 转 和 矩 。 

关节 弹性 存在 的 一 个 重要 方面 是 ， 每 个 关节 的 控 
制 法 则 中 的 反馈 部 分 一 般 取 决 于 四 个 变量 ， 电 动机 和 
连 杆 的 位 置 ， 以 及 电动 机 和 连 杆 的 速度 。 然 而 ， 在 大 
多 数 机 器 人 中 关节 弹性 并 没有 在 系统 设计 时 考虑 清 
楚 ， 最 多 只 有 两 个 传感器 用 于 测量 关节 参量 ; 一 个 位 
置 传感器 〈 比 如 编码 器 ) ， 在 某 些 情况 下 还 有 一 个 用 
做 速度 传感器 的 测速 计 。 当 没有 速度 传感器 时 ， 速 度 
通常 是 通过 对 合适 的 高 分 辩 率 位 置 测量 进行 数值 微分 
来 得 到 的 。 由 于 关节 弹性 的 存在 ， 实 际 测 得 的 位 置 / 
速度 数值 取决 于 这 些 传感器 安装 在 电动 机 /传动 机 构 
组 件 上 的 位 置 。 

个 通过 弹性 关节 驱动 的 独立 连 杆 可 以 被 作为 典型 


qi) 这 一 项 。 在 这 种 情况 下 ， 期 望 的 连 杆 轨迹 qu (2) 
应 该 有 一 个 连续 可 微 的 加 速度 (gy 应 该 存在 ， 因 为 
它 被 用 于 定义 w,)。 请 注意 ,任何 内 部 动力 学 方程 
(13.22) 的 初始 化 值 (0) 都 适用 于 从 式 (13. 21) 
初始 化 得 到 的 相关 电动 机 位 置 9,(0)， 也 就 是 说 ， 它 
产生 了 一 个 具体 的 转 矩 配置 ma (1) ， 并 得 到 相同 的 连 
FSS quG) 。 然 而 ,我们 应 该 联系 实际 的 机 如 人 手 
臂 的 初始 状态 。 例 如 ， 从 一 个 平衡 状态 开始 意味 着 
6,(0) =0 的 唯一 性 。 

一 种 类 似 的 程序 也 同样 适用 于 到 具有 弹簧 阻尼 的 
完整 模型 (13.7) 。 同 样 ， 动 态 逆 系 统 也 是 必需 的 。 
然而 在 这 种 情况 下 ， 对 与 gu(1) 的 平滑 性 要 求 甚至 
会 大 幅 降低 。 

总 结 而 言 ， 对 于 具有 柔性 连 杆 的 机 器 人 ， 逆 动力 
学 问题 也 引出 了 内 部 动力 学 问题 ， 和 模 态 阻尼 的 存在 
与 否 无 关 。 当 指定 一 个 要 求 的 柔性 手臂 末端 运动 时 ， 
相关 的 内 部 动态 变 得 不 稳定 ， 这 一 关键 问题 必须 被 解 


例子 ， 用 于 研究 使 用 不 同 部 分 状态 测量 时 产生 的 不 同 结 
果 。 这 提供 了 如 何 处 理 普 遍 性 的 多 重 问题 的 一 个 指导 。 

在 没有 重力 的 情况 下 ， 我 们 可 以 发 现 一 个 仅 基于 
电动 机 尺寸 的 比例 微分 (PD) 控制 器 便 足 以 达到 期 
望 的 调控 任务 。 在 存在 重力 的 条 件 下 ， 各 种 重力 的 补 
偿 方案 可 以 被 添加 到 PD 反馈 控制 器 中 。 只 要 这 些 应 
用 在 反馈 中 的 参考 量 被 确定 了 ， 便 能 仿照 刚性 关节 机 
顺 人 的 情况 进行 控制 。 

1. 单 弹性 关节 的 例子 

分 析 一 个 在 水 平面 上 的 旋转 的 独立 连 杆 (因此 
没有 重力 作用 ) ， 由 一 个 电动 机 通过 弹性 关节 耦合 来 
驱动 〈 见 图 13.4) 。 当 电动 机 和 连 杆 侧 的 黏 性 摩擦 以 
及 弹簧 的 阻尼 同时 作用 时 ， 动 力学 模型 为 


Mg +D(q -0) +K(q-0) +F,q =0 


BO «D(Ó —q) +K(0-q) +F,6 =T 
其 中 用 到 与 13. 1. 1 中 相同 的 符号 ， 这 里 是 标量 。 由 
于 该 系统 是 用 线性 方程 组 描述 的 ， 所 以 可 用 拉 普 拉 
变换 来 计算 传递 函数 ， 即 从 输入 转 矩 到 电动 机 位 置 


an 


机 器 人 结构 
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0(s) Ms +(D+F,)s+K 
Ts) den(s) 
以 及 从 输入 转 和 矩 到 连 杆 位 置 
q(s) _ Ds+K 


T(s) den(s) 

未 具有 共同 的 分 母 den (*) ， 由 下 式 给 出 

den(s) = | MBs +[M(D+F,) *B(D*F,)]s + 
[(M-B)K«-(F, c F.)D*F,F,]s c (F, € F,)Kis 
在 连 杆 位 置 作为 输出 的 情况 下 ,传递 函数 有 较 大 的 相 
KE (MERA). K 13. 6 和 图 13.7 为 以 上 两 
个 传递 函数 的 典型 频 响 特性 曲线 。 为 清楚 起 见 ， 设 定 
速度 为 输出 量 。 在 电动 机 输出 速度 的 幅 频 波 特 图 中 ， 
注意 存在 一 个 反共 振 / 共 振 现 象 。 类 似 的 ， 在 连 杆 速 
度 输出 中 有 一 个 纯 共振 ( 当 弹 得 阻尼 D Be pak F 
时 更 为 显著 )。 图 13.7 中 的 相位 具有 高 达 270° 的 相 
位 滞后 ， 也 表明 了 将 连 杆 参量 进行 团 环 反馈 控制 将 遇 
到 更 大 的 控制 困难 。 在 对 机 器 人 关节 进行 的 实验 测试 
中 ， 这 种 图 样 在 关节 柔性 集中 存在 时 是 很 典型 的 ， 因 
而 可 以 被 用 来 评估 这 一 现象 的 相关 性 以 及 用 来 确定 模 
型 参数 。 


电动 机 速 
— 动机 速度 输出 
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图 13. 6 电动 机 传输 速度 - 转 矩 波 特 图 
为 了 分 析 不 同 反馈 形式 的 稳定 性 ， 忽 略 所 有 的 耗 


散 效应 (最 坏 情 况 下 D=F = 了 =0)。 首 先 考虑 电动 
机 位 置 作为 输出 的 传递 函数 : 


BU Ms +K 
Ts) wads =| MBs’ +(M+B)K]s (13. 23) 
这 个 传递 函数 有 一 对 虚 零 点 和 极点 ， 以 及 原点 处 的 一 


个 二 重 极点 ， 其 零点 即 为 截止 频率 mw = VKM, € 
的 特点 是 当 电 动机 被 锁定 时 (0=0) 会 发 生 振荡 ， 
例如 通过 一 个 高 增益 的 位 置 反 馈 。 这 个 频率 是 用 来 评 


连 杆 速度 输出 
RB 
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图 13.7 转 矩 - 连 杆 速度 波 特 图 


佑 一 个 对 电动 机 变量 的 简单 PD 控制 的 极限 性 能 。 为 
了 使 朵 环 系统 有 足够 的 阻尼 ， 带 宽 就 应 该 是 有 限 的 ， 
根据 一 般 规律 ， 应 为 w 的 三 分 之 一 。 只 有 在 综合 
虚 弹 性 关节 的 四 阶 动 态 时 ， 才 可 能 达到 更 快 的 瞬 态 。 
同时 注意 到 ， 这 些 零点 的 频率 始终 低 于 式 (13.23) 
中 极点 的 频率 。 这 与 电动 机 转 矩 到 速度 的 映射 被 动 性 
有 关 ， 这 种 特性 有 益 于 稳定 性 和 自 适 应 控制 或 鲁 棒 控 
制 的 设计 。 
由 于 控制 目标 在 于 规范 连 杆 位 置 输出 ， 我 们 也 对 
开 环 传递 函数 感 兴 } 
E K 
we sa (BP OLEI) (or 
该 传递 函数 没有 零点 (事实 上 ,， 这 足以 使 得 有 
D =0)， 所 以 目前 最 大 可 能 的 相对 次 数 是 4。 我 们 应 
当 注 意 到 式 (13.24) 中 缺失 零点 的 非 线 性 部 分 也 将 
对 有 多 连 杆 的 柔性 连接 机 器 人 的 轨迹 控制 发 挥 相 应 的 
作用 


还 值得 一 提 的 是 ， 这 种 情况 与 将 弹簧 从 关节 处 移 
除 并 布置 在 连 杆 上 任意 他 处 的 情况 完全 不 同一 一 后 者 
只 是 对 连 杆 弹性 模型 的 一 个 简单 的 单 模式 近似 。 在 这 
种 情况 下 ， 类 似 的 传递 函数 将 拥有 两 个 对 称 的 实 零点 
( 非 最 小 相位 系统 ) ， 指 示 出 为 实现 期 望 连 杆 轨迹 ， 
系统 输入 - 输出 映射 直接 反 演 的 临界 状态 。 

有 了 通过 连 杆 参数 q 给 出 的 期 望 位 置 ， 用 单位 
置 变量 和 单 速度 变量 的 来 设计 线性 稳定 反馈 的 最 自然 
的 选择 是 使 用 连 杆 参数 的 PD 闭环 控制 

T=u, - (Kp. * Ky, ) (13.25) 
RP, Ky, Al K, ,分 别 为 位 置 和 速度 的 增益 ， 并且 
u, = Ky qa 作为 外 部 输入 用 于 定义 调整 点 。 很 容易 发 
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现 的 是 ， 无 论 增益 如 何 选 择 ， 闭 环 的 极点 都 是 不 稳定 
的 ， 所 以 要 避免 仅 来 源 于 连 杆 参量 的 误差 反馈 。 与 此 
相似 ， 电 动机 位 置 与 连 杆 速率 的 反馈 组 合 也 常常 是 不 


稳定 的 。 
另 一 种 混合 反馈 策略 是 利用 连 杆 位 置 和 电动 机 
速度 . 


T=u,-(Kp,q+Kp n0) (13.26) 
这 个 组 合适 用 于 例如 将 转速 传 感 咒 集成 在 直流 电动 机 
上 的 情况 ， 以 及 把 光电 编码 器 安装 在 负载 轴 上 来 测定 
位 置 的 情况 〈 不 需要 任何 关于 关节 和 柔性 的 信息 ) 。 利 
用 式 (13.26) 就 能 导出 闭环 特征 方程 
BMs! + MKy „5° + (B+M)Ks’ + KKy „s + KK, =0 
利用 Routh 判 据 ， 当 且 仅 当 电动 机 速度 增益 K, >0, 
且 连 杆 位 置 增益 满足 0 < Ks ,<K 时 ， 系 统 才 会 达到 
渐 近 稳定 ， 即 比例 反馈 不 超过 弹簧 刚度 的 限度 。 这 种 
上 界 的 存在 限制 了 这 种 方案 的 可 用 性 。 
最 后 ， 电 动机 变量 的 性 能 反馈 
T-u,-(K,,0 - Ky, O ) (13.27) 
只 要 Ky, A KR 都 严格 为 正 (或 者 无 穷 大 ) ， 该 闭环 
系统 就 会 达到 渐 近 稳定 。 这 种 有 利 特性 使 其 也 能 被 方 
便 的 推广 适用 于 多 连 杆 的 情况 。 

请 注意 ， 其 他 部 分 状态 反馈 组 合 合 也 是 有 可 能 
的 ， 它 取决 于 可 用 的 传 感 设备 。 例 如 ， 安 装 在 传动 轴 
上 的 应 变 仪 能 够 直接 测量 出 弹性 转 矩 =K(0 - q) 
用 于 控制 。 应 变 仪 对 于 柔性 连 杆 而 言 也 是 十 分 有 用 的 
传感器 。 事 实 上 ， 可 以 设计 全 状态 反馈 来 保证 渐 近 稳 
定 ， 并 大 大 改善 系统 的 瞬 态 特性 。 但 是 ， 这 将 增加 和 额 
外 的 传感器 成 本 ， 并 且 需 要 适当 调整 四 个 增益 。 

2. 仅 使 用 电动 机 变量 的 PD 控制 
对 于 在 无 重力 作用 的 普通 多 连 杆 情况 ， 我 们 分 析 
基于 电动 机 位 置 和 速度 反馈 的 PD 控制 
T=K,(0, -0)-K,0 (13.28) 
式 中 的 增益 矩阵 K, IK, 是 对 称 的 (典型 ， 对 角 ) 
正定 和 矩阵。 由 于 g8(9g) =0， 它 遵循 式 (13.19), ral 
机 位 置 的 参考 值 是 9, =g。( 稳定 状态 下 无 关节 偏转 ， 
不 需要 转 矩 输入 ) o 

控制 规律 (13.28) 总 体 上 渐 近 稳定 了 期 望 的 平 
fiUus q-20-q,, q =O =0。 这 可 以 通过 李 雅 普 诺 
夫 理论 证 明 ， 并 通过 拉萨 尔 定理 完善 。 事 实 上 ， 该 系 
统 的 总 能 量 (动能 加 弹性 势能 ) 和 由 比例 项 引起 的 
控制 能 (虚拟 弹性 势能 ) 的 总 能 量 和 给 出 了 一 个 候 
选 的 李 雅 普 诺 夫 函 数 : 


V-30./(0)0 +4 - 0) K(g - 0) + 


1 
5( 
在 由 式 (13.7) (或 式 (13.9)) 及 式 (13.28) 提供 
的 闭环 系统 的 轨迹 上 计算 V 的 时 间 倒 数 ， 并 考虑 斜 对 


FRAIA -2 多 可 推出 
V = -0'K,0 <0 


耗 散 项 (AVERE INSEE) 的 引入 会 使 了 更 趋 
向 于 半 负 定 。 通 过 验证 包含 于 状态 集合 中 的 最 大 不 变 


集 在 了 = 0 (BNO = 0 时 得 到 的 ) 简化 为 期 望 的 独特 
平衡 状态 ， 这 个 分 析 便 完 整 了 。 

我 们 发 现 ， 在 不 考虑 重力 的 情况 下 ， 可 以 使 用 一 

项 相同 的 控制 法 则 ， 将 柔性 连 杆 机 器 人 的 情况 普遍 地 

调整 到 期 望 的 关节 结构 。 在 这 情况 下 ， 式 (13.28) 
中 的 9 是 指 在 柔性 连 杆 机 器 人 基 座 上 的 刚性 坐标 。 

3. 常 重力 补偿 的 PD 控制 

由 于 重力 的 存在 ， 需 要 在 PD 控制 式 (13.28) 

中 增加 一 些 形式 的 重力 补偿 项 。 此 外 ， 还 需要 一 个 额 
外 的 结构 假设 ， 和 在 选择 控制 增益 时 的 谨慎 考虑 。 

在 开始 之 前 ， 我 们 回顾 一 下 重力 矢量 g(g) (在 

A2 假设 下 , st (13.7) 中 的 重力 矢量 是 与 等 效 刚性 

机 器 人 动力 学 中 的 重力 矢量 相同 ) 的 一 个 基本 属性 : 

对 于 具有 旋转 关节 的 机 器 人 ， 无 论 是 否 为 柔性 ， 都 存 
在 正常 数 a 使 得 

e. 

oq 

矩阵 4(9) 的 范 数 是 通过 欧式 范 数 诱导 得 到 的 ， 即 
Al VAn CATA) 。 不 等 式 (13.30) 可 推 得 

lea) -8(%) soia, -gl 


0, -0)'K,(0, -0) 20 (13. 29) 


xa, VqeR" (13. 30) 


Vga,gy eR" 
(13.31) 
在 常见 的 做 法 中 ， 机 器 人 关节 不 可 能 超出 实际 情况 无 
限 柔 软 。 更 确切 地 说 ， 根 据 机 器 人 自重 的 负荷 ， 他 们 
有 足够 的 刚度 来 支持 一 个 特定 的 连 杆 平衡 位 置 Y。， 
这 个 平衡 位 置 与 任意 指定 的 固定 电动 机 位 置 9. 有 
关 一 一 式 (13.19) 给 出 了 这 种 关系 的 反 向 表达 。 这 
种 情况 并 不 是 一 种 限制 ， 反 而 可 以 作为 进一步 的 模型 
假设 : 
AS. 最 低 关节 刚度 要 大 于 作用 了 
ddp be, RER 
min;_; yK; >a 
处 理 存 在 重力 的 情况 的 最 简单 修正 方法 是 考虑 增 
加 一 个 常数 项 ， 使 其 在 期 望 的 稳定 状态 下 完全 抵消 重 
力 载荷 。 根 据 式 (13.19) 和 式 (13.20), ， 控 制 规律 
(13.28) 可 以 被 修改 为 


机 器 人 上 的 重力 
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T-K,(0,-0) -Ko0 +8(q4) (13.32) 
RPK, >0 (作为 最 小 值 )， 为 典型 对 角 的 对 称 阵 ; 
同时 K, >0; H0,-q,-K^'g(qu) 给 出 了 电动 机 
参数 。 


一 个 保证 gq =g,09=0,,4=0=0 是 系统 


ANE (13.33) 中 存在 真正 的 刚度 值 。 事实 上 ， 机 带 
人 将 会 收敛 到 一 个 不 同 于 期 望 情 况 的 平衡 点 上 ， 越 精 
确 地 估计 K 和 g (gq,)， 真 实 平衡 点 便 越 接 近 于 期 
望 值 。 

4. 在 线 重力 补偿 PD 控制 

与 刚性 机 器 人 的 情况 类 似 ， 如 果 运动 过 程 中 重力 


= 


(13.7) 在 控制 法 则 (13.32) 下 达到 全 局 渐进 稳定 
平衡 的 充分 条 件 是 : 
aall | J >a — (13:33) 
"ULUL-K K+K, 
UP, a 在 式 (13.30) 中 被 定义 。 考 虑 到 天 IK, 
的 对 角 结 构 ， 且 由 于 AS 假设 , 通过 增加 控制 器 的 最 
小 比例 增益 (AEE K, 不 为 对 角 阵 时 ， 即 为 增加 K, 
的 最 小 特征 值 ) ， 我 们 总 能 够 满足 这 个 条 件 。 


补偿 (或 更 精确 的 ， 完 全 抵消 重力 作用 ) 被 应 用 于 
所 有 结构 中 ,， 便 可 以 期 待产 生 更 好 的 瞬 态 过 程 。 但 
fe, 式 (13.7) 中 的 重力 向 量 取 决 于 连 杆 参数 g， 而 
它 目 前 被 认为 是 不 可 测 的。 很 容易 发 现 ， 利 用 g( 0) 
以 及 用 测 得 的 电动 机 位 置 来 取代 连 杆 位 置 ， 一 般 会 导 
致 错误 的 闭环 平衡 。 此 外 ， 即 使 4 可 测 , Hi gl) 添 
到 一 个 电动 机 PD 误差 反馈 中 并 不 能 保证 成 功 控制 ， 
因为 这 种 出 现在 电动 机 方程 中 的 补偿 并 不 能 立即 消除 
作用 在 连 杆 上 的 重力 载荷 。 


下 面 ， 我 们 将 简 述 一 下 该 条 件 的 目的 及 渐 近 稳定 
性 的 相关 证 明 。 闭 环 系统 的 平衡 位 置 是 以 下 方程 组 
的 解 


K(q-0) *g(q) =0 
K(0-4) - K,(0,-0) -g(q,) =0 

事实 上 ， 数 组 (qu, 0,). 满足 以 上 方程 组 。 然 而 
为 了 获得 方程 组 的 通 解 ， 需 要 保证 此 数组 为 方程 组 的 
特 解 。 因 此 ， 回 顾 式 (13. 19) ， 可 在 两 个 方程 中 加 
上 或 减 去 空 项 K(0, -di) —2(q,) 以 得 到 

K(q-4,) -K(0-0)=g(q) -8(q) 

-K(q-4,) +(K+K,)(0-6,) =0 
其 中 可 以 容易 发 现 条 件 (13.33) 中 的 和 矩阵。 对 等 式 
两 边 取 范 数 ， 同 时 用 式 (13. 31) 限定 重力 项 ， 则 引 
入 的 条 件 (13.33) 表明 ,数组 (g,，0,) 事实 上 就 
是 平衡 的 特 解 。 为 了 表示 渐 近 稳定 性 ， 基 于 无 重力 的 
情况 (13.29) ,我们 可 以 构造 一 个 候选 的 李 雅 普 诺 
ES pou 
Va =V+ Cory CO) — A as (Ga) = (q-4,)'&(q,) = 


(13. 34) 


e )K~'g(q,) 20 
BUJA — A BONETE a FEV, 的 最 小 
值 为 零 。 的 正定 性 及 其 特定 最 小 值 正 处 于 期 望 状 
态 下 的 特性 再 次 被 条 件 (13.33) 所 证 实 。 通 过 一 般 
的 计算 ,应 用 拉萨 尔 定理 可 以 得 出 结论 : V ,= -07 


g 


K, 0 <0, 

控制 规律 (13.32) 只 基于 重力 项 g(g,) 和 关节 
刚度 K。 后 者 还 出 现在 电动 机 参量 o, 的 定义 中 。 重 
HF glg) 和 关节 刚度 的 不 确定 性 会 影响 控制 器 
的 性 能 。 尽 管 如 此 ， 仍 然 存 在 一 个 独特 的 闭环 平衡 ， 
日 它 的 渐进 稳定 性 在 当 重 力 被 a 约束 时 存在 ， 并 日 


考虑 到 这 一 点 ， 我 们 可 以 引入 如 下 的 在 线 重 力 补 


偿 PD 控制 。 定 义 变量 


0=0-K-!'g(g,) (13.35) 
为 测定 的 电动 机 位 置 9 的 一 个 重力 偏差 修正 量 ， 并 令 


T-K,(0,-0) -K,0 «g(0) (13.36) 
XB, Kp >0 和 K, >0 都 是 对 称 和 矩阵 (H XY fi E 
阵 )。 控 制 法 则 (13.36) 在 只 运用 电动 机 变量 的 条 


件 下 仍然 有 效 。g( 0) 项 只 是 近似 抵消 了 运动 过 程 中 
的 重力 〈 虽 然 是 很 大 一 部 分 ) ， 但 导致 了 稳定 状态 下 
正确 的 重力 补偿 。 事 实 上 ， 通 过 式 (13.19) M 
(13.35), ， 可 得 出 


0,: - 0, -K'g(qj) -4Q, 


因此 g( 0,) 2g(q,) 

在 用 于 常 重力 补偿 的 相同 条 件 (13.33) 情况 
下 ， 也 能 保证 期 望 平衡 状态 的 全 局 渐进 稳定 性 。 和 定义 
一 个 稍微 不 同 的 候选 方程 一 一 李 雅 普 诺 夫 函 数 ， 从 式 
(13. 29) 开始 重新 推导 如 下 

V, =Y+2 A) -Yan (O) 


jos. : 
58 («)K 'g(q,) 20 


与 式 (13.34) 进行 对 比 。 

在 线 重力 补偿 法 的 应 用 通常 提供 了 一 个 更 平滑 的 
时 间 过 程 以 及 位 置 瞬 态 误差 的 显著 减少 ， 并 且 没 有 增 
加 额外 的 峰值 转 矩 和 平均 转 矩 的 控制 任务 。 我 们 注意 
到 ， 即 使 极 大 违反 了 稳定 性 的 充分 条 件 (13.33), 
选择 低位 置 增益 可 能 仍然 适用 ， 这 与 常 重力 补偿 的 情 
况 相 反 。 然 而 同样 的 增加 关节 刚度 值 ， 在 K— oo 时 ， 
确保 精确 调控 的 K, 的 可 行 值 范围 并 不 会 降低 到 零 。 
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一 种 同样 基于 电动 机 位 置 测量 的 在 线 重力 补偿 方 
案 的 可 能 改进 方法 是 通过 应 用 一 种 快速 迭代 算法 ， 详 
细 计 算 9 值 来 生成 即时 (不 可 测 的 ) q 的 准 静 态 佑 计 
值 g( 9) 。 事 实 上 ， 在 任何 稳 态 结构 (q, 0) F, 从 
q, 到 0, 定义 了 一 个 直接 映射 
0,-h,(q)):-4, * K 'g(q,) 
AS (Ett EMRE RIY q, = (9,) 的 存在 性 和 唯 
一 性 。 对 于 一 个 测 得 的 9， 函数 
q-T(q):-0-K g(q) 
成 为 一 个 收缩 映射 ， 而 如 下 迭代 
Qi. =T(q;) ,i=0,1,2. 
将 收敛 到 这 个 映射 的 不 动 点 上 ， 人 恰 为 9(9) = 有 hh 
(0). do 的 一 个 合适 的 初始 量 是 测量 值 9 或 在 之 前 采 
样 时 刻 中 计算 得 到 的 9g。 用 这 种 方法 ， 只 需要 经 过 两 
三 次 迭代 便 能 获得 足够 的 精度 ， 而 且 这 个 过 程 足够 快 
速 ， 是 以 在 数字 机 器 人 控制 占 的 一 个 传 感 /控制 采样 
间隔 内 完成 。 
有 了 这 个 在 后 台 运 行 的 迭代 方法 ， 调 控 方 法 变 成 
T-K,(0,-0) -K,0 «g[q(0)] (13.37) 
其 中 对 称 (对 角 ) EEK, >0, HK, >0。 通 过 进 一 
步 修 证 之 前 的 李 雅 普 庄 夫 候 选 值 ， 我 们 可 以 证 明 该 控 
制 方案 的 总 体 渐 近 稳定 性 。 式 (13.37) 的 优势 在 于 
其 允许 任意 正 的 反馈 增益 K, 值 ， 如 此 便 涵盖 了 完全 
抵消 重力 作用 的 刚性 条 件 下 的 整个 工作 空间 。 
在 线 重力 补偿 计划 (13.36) Æ (13.37) 都 实 
现 了 关节 空间 内 只 有 电动 机 参量 情况 下 的 柔顺 控制 。 
同样 的 想法 还 可 以 扩展 到 笛 卡 儿 和 柔顺 控制 ， 通 过 评估 


机 器 臂 的 直接 运动 学 和 雅 可 比 (变换 )， 其 中 用 0 或 
分 别 使 用 g(0) 来 替代 qc 

5. 全 状态 反馈 

当 反馈 法 则 基于 对 机 器 人 状态 的 全 部 测量 值 时 ， 
调控 法 则 的 瞬 态 性 能 将 会 有 所 改善 。 利 用 一 个 关节 
力矩 传感器 ， 我 们 可 以 得 到 柔性 关节 机 器 人 简化 模 
型 的 一 种 方便 设计 ， 其 包含 了 弹簧 阻尼 作为 耗 散 项 。 
全 状态 反馈 可 通过 将 初步 转 矩 反馈 和 式 (13. 28) 
中 的 电动 机 反馈 法 则 相 结 合 ， 从 而 分 为 两 个 阶段 
实现 。 

HT -K(0-q) 可 将 电动 机 方程 改写 为 

BÖ +T+DK t-T 

关节 力矩 反馈 为 

T-BB;u*(I-BB; )( t1 DK! &) (13.38) 
SUP, w 是 一 个 设计 辅助 输入 ， 将 电动 机 方程 组 变形 


为 B,0 + 石 +DK- 记 =&， 通 过 这 种 方式 可 以 将 


电动 机 的 明显 惯性 降低 至 一 个 期 望 的 任意 小 的 值 B,， 
这 在 存在 振动 阻尼 的 情况 下 有 明显 好 处 。 例 如 在 线性 
和 标量 情况 下 ， 一 个 很 小 的 B 将 式 (13.23) 中 的 一 
对 复杂 极点 转移 到 一 个 非常 高 的 频率 处 ， 同 时 关节 运 
动 几乎 是 刚性 的 。 

设 定式 (13.38) 中 

u -K,,(0,-0) -Ky,0 «g(q) 

导致 状态 反馈 控制 器 


T-K,(0,-0) -K, 0 *K,[g(q))-t]- 


K; t; *g(q,) (13.39) 
其 增益 为 

K, - BB; K,, 

K, -BB; K,, 

K, =BB,' -I 
A 


K, = (BB;' -I)DK- 
FKE, WRC eae HAT, YAM (13.39) 也 
MTL (0, q, 0, q) 参数 来 改写 。 但 是 ， 保 持 增 
益 的 这 种 结构 ， 能 够 保留 全 状态 反馈 控制 器 实现 了 什 
么 的 有 趣 物理 解释 。 


13.1.4 轨迹 跟踪 


对 于 刚性 机 械 臂 来 说 ， 和 柔性 关节 机 器 人 跟踪 期 望 
的 时 间 变 化 轨迹 的 问题 难于 实现 恒定 调控 。 通 常 ， 解 
决 这 个 问题 需要 利用 全 状态 反馈 以 及 动力 学 模型 中 所 
有 变量 的 信息 。 

在 这 些 条 件 下 ， 我 们 应 该 重点 考虑 反馈 的 线性 化 
方法 ， 即 一 个 非 线性 状态 反馈 法 则 ， 它 能 使 机 器 人 的 
全 部 NN 个 自由 度 (事实 上 ， 即 连 杆 变量 g) 情况 下 闭 
环 系统 具有 解 耦 和 严格 线性 行为 。 沿 着 参考 轨迹 的 跟 
踪 误 差 必 须 为 全 局 指数 性 稳定 ， 具 有 可 以 通过 控制 器 
中 标量 反馈 增益 的 选择 来 直接 指定 的 衰减 率 。 这 一 根 
本 性 的 结果 便 是 用 于 刚性 机 器 人 的 知名 力矩 计算 方法 
的 直接 延伸 。 因 为 其 相关 的 特性 ， 反 馈 的 线性 化 可 以 
被 作为 评价 其 他 任何 轨迹 跟踪 控制 规则 性 能 的 一 个 参 
考 ， 这 也 许 能 运用 较 少 /近似 模型 信息 及 /或 仅 部 分 状 
态 反 馈 来 设计 得 到 。 

然而 ， 由 于 关节 和 柔性 的 存在 ， 反 馈线 性 化 法 则 的 
设计 并 不 能 直接 获得 。 此 外 ， 只 要 S 头 0， 动态 模型 
(13.7) 将 无 法 满足 对 精确 线性 化 (或 输入 -输出 去 
TA) 的 现 有 必要 条 件 ， 当 全 状态 中 只 有 一 个 稳 态 
(或 瞬 态 ) 反馈 法 则 可 用 。 因 此 ， 我 们 将 把 我 们 的 注 
意 力 限制 在 更 容易 处 理 的 简化 动力 学 模型 (13.9), 
仅 大 致 的 描述 一 下 总 体 情况 。 
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至 于 第 二 个 更 简单 的 轨迹 跟踪 方法 ， 我们 也 提出 
了 一 个 利用 基于 模型 的 前 馈 命 令 和 预先 计算 的 状态 参 
考 轨迹 的 线性 控制 设计 ， 它 从 13. 1. 12 的 逆 动 力学 计 
算 中 获得 ， 在 全 状态 中 增加 了 一 个 线性 反馈 。 在 这 种 
情况 下 ， 收 敛 到 期 望 轨 迹 只 是 局 部 被 保证 ， 即 跟踪 误 
差 应 足够 小 ， 但 控制 的 实现 很 简单 旦 大 大 减轻 了 实时 
计算 负担 。 

1. 反馈 线性 化 

考虑 简化 模型 (13.9)， 并 用 期 望 的 光滑 连 杆 运 
Bh qy(t) 来 指定 参考 轨迹 。 该 控制 设计 将 从 系统 反 
演 开始 ， 用 类 似 13. 1. 12 中 的 逆 动 力学 运算 方法 ， 但 


使 用 状态 参量 的 即时 测定 值 (q, 0, q, 0) 取代 参 


考 状 态 测量 值 (gq,，0,;,，44，0,)。 值 得 注意 的 是 ， 
有 没有 必要 将 机 器 人 方程 转 组 化 为 他 们 的 状态 -空间 
描述 ,虽然 这 种 描述 是 一 般 非 线性 系统 控制 设计 的 标 
准 形式 ; 我 们 将 直接 使 用 机 器 人 模型 的 二 阶 微分 形式 
(机 械 系 统 的 典型 方法 ) 。 

道 运算 过 程 的 结果 将 以 静态 状态 反馈 控制 法 则 的 
形式 作为 力矩 的 定义 ， 这 种 形式 取消 了 原始 的 机 顺 
人 动力 学 ， 并 用 一 个 具有 合适 微分 阶 数 的 期 望 的 线性 
解 耦 动力 学 蔡 代 了 它 。 从 这 个 意义 上 来 说 ， 这 种 控制 
理论 使 得 具有 弹性 关节 的 机 器 人 动力 学 的 刚性 变 大 。 
在 不 引起 稳定 性 问题 的 前 提 下 将 系统 从 选 定 的 输出 9 
进行 逆 变 的 可 行 性 〈 涉 及 抵消 后 的 闭环 控制 系统 中 
存在 不 可 观测 的 动态 过 程 ) ， 是 弹性 关节 机 器 人 的 一 
个 相关 特性 。 事 实 上 ， 这 是 对 于 非 线 性 多 输入 多 输出 
系统 (MIMO) 和 傅 况 下 ， 在 缺失 零点 时 标量 传递 函数 
进行 逆 变 的 可 能 性 的 直接 推广 。 (参见 式 (13.24) 
中 所 作 的 分 析 ) o 

用 简洁 的 形式 重 写 连 杆 方程 如 下 

M(q)q +n(q,q) +K(q-@) -0 (13.40) 

RPS n(q,d) 2c(a4,4) +8(9) 

上 述 数 量 都 不 取决 于 瞬间 的 输入 转 矩 r。 因 此 ， 我 们 
可 以 求 一 次 微分 ， 得 到 


M(q)q? «M(q) d *n(q,d) +K(q -0)-0 


(13.41) 
再 求 一 次 微分 得 到 
M(q)q* +2 M(q)q™ +M (q) @ + 
H(q,d) *K(q-0)-0 (13.42) 


其 中 出 现 了 0 。 电 动机 加 速度 和 7 在 电动 机 方程 中 是 
同 阶 的 


BO +K(0-q)=T (13.43) 


从 而 ， 替换 式 (13.43) 中 的 9 ， 我 们 得 到 


M(q)q^ +2 M(q)q™ +M(g) d +i (4,4) + 
Ky -KB"[T-K(0-4)] (13. 44) 
我 们 注意 到 利用 式 (13.40) , x (13.44). 的 最 后 一 
H K(0-q) 也 可 以 用 M(q) d «n(q, 4) RFR. 
由 于 矩阵 4(4) - M^ (q) KB -总 是 非 奇异 的 ， 
通过 合适 选择 输入 转 矩 r+， 一 个 任意 值 v 都 可 以 被 分 
配 到 4g 的 第 四 阶 导数 中 。 算 了 泗 A(q) 就 是 所 谓 的 系统 
去 耦 和 矩阵， 而 它 的 非 奇 异性 是 通过 非 线 性 静态 反馈 得 
到 一 个 解 耦 的 输入 输出 -特性 的 充 要 条 件 。 另 外 ， 式 
(13.44) RIH, q 的 每 个 元 素 q; 都 需要 被 微分 7, =4 
次 ， 从 而 能 够 在 代数 上 与 输入 转 矩 + 联系 起 来 ( 当 
被 选 定 为 系统 输出 时 ,7; 是 q; 的 相关 度 ,)。 因 为 有 
N 个 连 杆 变量 ， 关 联 度 的 总 和 是 4NW， 与 具有 弹性 关 
节 的 机 器 人 的 状态 维度 相等 。 综 合 考虑 所 有 这 些 事实 
会 得 到 如 下 结论 : 当 逆 转 式 (13.44) 来 确定 产生 
q” =7 的 输入 量 z 时 ， 除 了 那个 出 现在 输入 输出 闭环 
映射 中 的 动力 学 参量 以 外 ， 将 没有 其 他 动力 学 参量 剩 
下 了 。 
因此 ， 选 择 
t-BK'[M(q)v*o(q,d.d ,.q^)] + 
[M(q) +B]g +n(q,q) (13. 45) 


其 中 


a(q.d.d q^ ) -M(q) à +2M(qg)q * li (4,4) 
RP, a 中 的 各 项 按照 g 的 微分 阶 数 的 增 序 排列 。 控 
制 法 则 (13.45) 引出 了 一 个 闭环 系统 ， 可 用 
q!“ =v (13.46) 
充分 描述 。 即 从 每 个 辅助 输入 量 "到 每 个 连 杆 位 置 
输出 量 q 的 四 个 输入 -输出 的 集成 链 ， 其 中 六 = 
L,e, No 因此 该 机 器 人 系统 已 经 被 非 线性 反馈 法 
WW (13.45) 完全 线性 化 和 解 耦 了 。 
完整 的 控制 法 则 (13.45) 仅仅 是 所 谓 的 线性 坐 
标 (qd, d, d, qU) 的 函数 表达 。 这 曾经 导致 了 
一 些 误解 ， 因 为 看 起 来 似乎 柔性 关节 机 器 人 的 反馈 线 
性 化 途径 需要 直接 测 得 连 杆 加 速度 了 和 急 动 度 q, 


旧 这 些 量 用 现 有 传感器 是 不 可 能 测 得 的 (或 需要 实 
时 位 置 测量 值 的 多 重 数值 微分 ， 并 带 来 严重 的 噪声 问 


题 ) 。 

当 考 虑 到 该 领域 的 最 新 技术 时 ， 现 在 有 一 套 精 确 
可 靠 的 传感器 可 用 于 测量 柔性 关节 的 电动 机 位 置 9 
(也 可 能 是 其 速度 0 ) ， 关 节 转 矩 =K(0-q4) 以 及 
连 杆 位 置 Y。 例 如 ，LWR- 亚 轻 质量 机 械 臂 每 个 关节 
上 的 传感器 布置 如 下 ， 其 中 霍 尔 传感器 用 于 测量 电动 
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机 人 位置， 关节 力矩 传 感 是 基于 应 变 传 感 器 的 ， 同 时 高 
端 电容 式 传感器 用 于 测量 连 杆 位 置 ( 见 图 13.8) 。 因 
此 ， 只 需要 一 项 数值 微分 便 可 以 很 好 地 估计 g 和 /或 
Tt。 注意 ,根据 具体 的 传感器 分 辨 率 ， 利 用 测 得 的 0 
jn 转化 为 9-K-! n, RFRA q 也 是 很 方便 的 。 
x 
传感器 十 字 滨 简 轴 承 能 量 转 换 单元 
关节 和 电动 机 控制 板 
n 


IK NC T c 


带 有 数字 接口 
LI NM 
EI 
Hep 和 位 置 传感器 

的 DLR 机 器 人 

驱动 装置 
碳纤维 机 器 
AH 


图 13. 8 DLR LWR- 亚 轻 量 型 机 械 手 及 其 传感器 组 件 爆炸 图 


考虑 到 这 一 点 ， 很 容易 发 现下 面 三 组 4N 变量 

(9,4,4,9°),(4,0,4,0),(4,T,4,%,) 
都 是 具有 弹性 关节 机 器 人 的 等 效 状态 变量 ， 其 均 与 整 
体 逆 变换 相关 。 

因此 ， 在 该 动力 学 模型 可 用 的 假设 下 ， 我 们 完全 
可 以 用 更 传统 的 状态 参量 (q, 0, 4, 0) 来 改写 线 
性 化 反馈 控制 法 则 (13.45), Bee, RI E 
传感器 , 用 (q, c, q, tj) 来 改写 。 特 别 的 是 ， 
作为 式 (13.40) 和 式 (13.41) 的 副 产 物 ， 我 们 有 

4 =M (gq)[K(0-g)-n(g,g)] 
-M^(q)[m-n(q.4)] 


(13. 47) 
和 
q^ -M^"(D[K(0 - 4) -M(q) d -"(4,4)] 
-M^(q)[t,-M(q) d -n(q,d)] 
(13. 48) 
其 中 ， 出 现在 式 (13.48) 中 的 加 速度 了 已 通过 式 
(13.4) 解 出 。 因 此 ， 精 确 线性 化 和 解 耦 控制 法 则 可 
以 用 静态 状态 反馈 法 则 r = T(q, 0, d, 06, v) 或 
T=1(q, t, 4, T,, v) 的 形式 被 改写 。 事 实 上 ， 
为 了 节约 计算 时 间 ， 出 现在 这 些 表 达 式 中 的 动态 模型 
参量 的 各 种 微分 形式 都 需要 被 合理 组 织 。 


基于 结果 (13.46) ， 轨 迹 跟 踪 问 题 的 解决 是 通 
过 设置 

v =q +K (q7 -gq )*K((d-d)* 

K, (qi - 9) * KK(q,-q) (13. 49) 

式 中 ,假定 参考 轨迹 qu) (ED) 三 阶 连续 可 导 
( 即 四 阶 导数 gi"! 存在 ) 。 并 且 对 角 和 矩阵 K,，…，K， 
有 元 素 使 得 

s+Kkyss + Ky ss +Kiss+Ko; i=1,,N 
EIER (Hurwitz) 多 项 式 。 考 虑 到 已 完成 去 看 ， 
第 i 个 连 杆 的 轨迹 位 置 误差 6.(1) qu (1) - q; (1) 
满足 


el”) + Ky e! +K, ,e, & K,;e; t Ky;e; 20 
对 任何 初始 状态 ，e; (1) 一 0 以 全 局 指数 型 的 方式 成 
立 。 一 系列 的 结论 如 下 所 示 


1) 当初 始 状态 (q(0), 6(0), q (0), 6 (0)) 
与 参考 轨迹 以 及 t=0 时 刻 它 的 前 三 阶 微分 相 匹配 时 
(13.47, 13.48 用 于 检查 ) ， 始 终 都 能 精确 再 现 参考 
轨迹 。 

2) 在 参考 位 置 轨迹 或 其 前 三 阶 微分 中 有 任何 一 
个 不 连续 的 情况 下 ， 对 于 时 间 1”e [0，7T] ， 轨 迹 误 
差 将 在 1=1" 时 刻 出 现 并 再 次 以 规定 的 指数 比例 衰减 
到 零 ， 与 每 个 连 杆 之 间 都 独立 。 

3) 增益 有 ,，，…， 且 ;的 选择 可 由 极点 配置 来 确 
定 (相当 于 特征 值 分 配 情况 )。 令 AA,，…， AL 为 四 
个 具有 负 实 部 的 极点 ， 其 可 能 是 成 对 出 现 以 及 /或 者 
重合 ， 并 且 指 定 了 该 轨迹 误差 的 期 望 瞬 态 。 这 些 闭 环 
极点 可 以 通过 正 的 实 增益 的 唯一 选择 来 分 配 。 


K, ;= —(A, +A, +À, A4) 
Ky, =A, (A, +As A4) ÀA CA3 A4) + AA 
K=- [ALÀ CAs * 44) +AA, (À, +A) | 
Ky i =AiA2A3A4 


当 连 杆 惯 性 和 电动 机 惯性 值 有 很 大 差别 时 ， 或 当 关 节 
刚度 非常 大 时 ， 上 述 固定 增益 的 选择 有 导致 过 大 控制 
工作 量 的 缺点 。 在 这 些 情况 下 ， 一 组 更 适合 的 特征 值 
可 以 调整 它们 的 位 置 以 形成 一 个 关于 机 器 人 惯性 和 关 
节 刚 度 的 物理 数据 的 函数 。 

4) 与 刚性 机 器 人 力矩 计算 方法 相 比 ,由 式 
(13.45) 式 (13.47) ~ 式 (13.49) 给 出 的 轨迹 跟踪 线 
性 化 控制 反馈 需要 惯性 矩阵 M (q) 的 逆 矩 阵 ， 以 对 
该 惯性 和 矩阵 和 动力 学 模型 中 其 他 参量 微分 的 额外 
评估 。 

5) 反馈 线性 化 方法 无 需 任 何 变化 ， 同 样 可 应 用 
FH PL AE AE A DC Bb EEE (或 其 他 摩擦 ) 的 情 
况 。 弹 簧 阻尼 的 引入 导致 了 一 个 辅助 输入 " 与 4 之 间 
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的 三 阶 解 耦 微分 关系 ， 因 此 在 闭环 系统 中 产生 了 一 个 
不 可 见 但 渐进 稳定 的 N 维 动态 。 在 这 种 情况 下 ， 只 
有 输入 -输出 (而 非 全 状态 ) 线性 化 和 人 解 看 可 以 
实现 。 

最 后 ,我 们 考虑 弹性 关节 机 絮 人 的 一 般 模 型 


确 线性 化 。 

2. 线性 控制 设计 

轨迹 跟踪 的 线性 化 反馈 法 带 来 了 一 个 相当 复 
杂 的 非 线性 控制 法 则 。 它 的 主要 优势 是 在 整体 范 
围 内 迫使 轨迹 误差 动态 上 的 线性 解 看 行为 能 够 被 一 


(13.7) 的 精确 线性 化 /去 厢 。 不 幸 的 是 ， 由 于 连 杆 
与 转子 之 间 存 在 惯性 耦合 矩阵 S(g) ， 上 述 的 控制 设 
计 无 法 继续 应 用 。 以 式 (13.7) 中 具有 相关 模型 简 
化 的 常数 $ 为 例 。 从 电动 机 方程 组 9 =B! (T- 
n-S'4) 中 解 出 86， 并 代入 连 杆 方程 组 ， 得 出 
[M(q) -SB'S']d +n(q,q) - 
(I«SB^)T,--SB't 

在 这 种 情况 下 ， 输 入 转 矩 z 已 经 在 连 杆 加 速度 q 的 
表达 式 中 出 现 了 。 利 用 式 〈13.6) ， 解 耦 和 矩阵 的 表达 
式 为 


A(q) = -[M,(q) +Mi(q)] ' SB" 
由 于 13.5 中 5 的 结构 ,4(4) DAWE, Ate, 无 
法 获得 (至少 ) 输入 -输出 线性 化 和 项 态 反 馈 解 耦 的 
必要 条 件 。 
然而 ， 通 过 使 用 更 大 类 的 控制 法 则 ， 仍 有 可 能 获 
得 一 个 精确 的 线性 化 和 解 耦 结果 。 为 此 ， 考 虑 如 下 形 
式 的 动力 学 状态 反馈 控制 器 


T=a(q,4 0,0 £) «B(q,d ,0,0 £)v 


E -y(q.d 0,0 ,€) «ó(q.d 0,0 ,£)v 
(13. 50) 
式 中 , Ee R" 是 动态 补偿 器 的 状态 ; e, B, y, 6 是 
合适 的 非 线 性 向 量 函 数 ; v eR 是 ( 同 前 ) 用 于 轨 
迹 跟 踪 的 外 部 输入 。 一 般 情况 下 ， 可 以 设计 一 个 最 高 
阶 数 是 v=2N(N -1) 的 动态 补偿 器 式 (13.50) ， 以 
便 获 得 一 个 用 q^) =w 替代 式 (13.46) 来 进行 全 
局 描述 的 闭环 系统 。 我们 发 现 ， 此 处 微分 阶 数 与 
13. 1. 2 中 期 望 轨迹 的 精确 重 现 ga) 的 阶 数 恰巧 相 
同 。 这 样 ， 跟 踪 问题 就 可 以 通过 对 式 (13.49) 的 线 
性 稳定 性 设计 进行 直接 归纳 来 解决 。 
给 这 种 控制 结果 一 个 物理 解释 是 很 有 意思 的 。 模 
型 (13.7) 的 输入 -输出 解 看 的 结构 性 障碍 是 连接 在 
弹性 关节 上 的 连 杆 的 运动 被 来 自 于 其 他 弹性 关节 的 转 
和 抑 影 响 过 早 〈 在 二 阶 微分 层面 上 ) 。 这 是 由 于 电动 机 
和 连 杆 之 间 存 在 的 惯性 看 合 。 控 制 器 中 的 附加 动力 学 
元 件 〈 即 积分 器 ) 减缓 了 这 些 低 能 量 路 径 ， 并 人 允许 
所 处 关节 处 〈 四 阶 微分 路 径 ) 弹性 转 抢 的 高 能 效应 
发 挥 作用 。 这 种 动态 平衡 允许 ( 带 有 机 器 人 和 控制 


个 作用 于 参考 轨迹 上 只 能 达到 局 部 稳定 的 控制 设计 
所 交换 ， 但 更 容易 实现 ( 且 有 可 能 在 更 高 采样 频率 
上 运行 ) 。 

为 此 ，13.1.2 中 的 道 动力 学 结果 可 以 被 应 用 ， 
无 论 是 简化 的 还 是 完整 的 机 器 人 模型 ， 也 无 论 是 否 有 
耗 散 项 。 只 要 给 定 一 个 有 足够 光滑 的 期 望 连 杆 轨迹 
gu(1) ， 总 能 得 到 以 下 相关 要 素 : 精确 再 现 所 需 的 额 
ERRE Ta (0), ， 以 及 所 有 其 他 状态 参量 的 参考 演变 
( 即 13. 13 给 出 的 0,(t) 或 Tha(1))。 这 些 信号 为 系 
统 定义 了 一 种 稳 态 运行 。 

一 个 更 简单 的 轨迹 控制 器 结合 了 一 个 基于 模型 的 
前 馈 系 统 和 利用 轨迹 误差 的 线性 反馈 系统 : 线性 反馈 
使 系统 在 参考 状态 轨迹 周围 局 部 稳定 ， 而 前 馈 扭 矩 则 
负责 当 错 误 消失 时 维持 机 器 人 沿 着 期 望 的 动作 来 


运用 全 状态 反馈 ,该 类 型 中 两 种 可 能 的 控制 
ar: 


T= Ta + K,,(0, -0) +K, ol 0, -0 ) + 


K, (4,74) + Ky (44-4) 
(13.51) 
以 及 

T= T; & K,,(0, 0) +K,,(0,-0) + 

K, (Tia - T) + Ky ,( t, = t) 
(13.52) 
这 些 轨 迹 跟踪 方案 在 具有 弹性 关节 的 机 器 的 控制 
实例 中 是 最 常见 的 。 在 缺少 全 状态 测量 时 ， 可 以 与 某 
些 未 测量 参量 的 观察 相 结合 。 这 样 可 以 获得 更 简单 的 
A. 


T= T; «K,(0,-0) +K,(0,-0) (13.53) 
这 个 方法 仅仅 只 用 到 了 电动 机 的 测量 ， 并 且 只 依赖 于 
规定 情况 下 获得 的 结果 。 

用 于 式 (13.51, 13.52, 13.53) 中 的 不 同 的 增 
益 和 矩阵 必须 用 机 器 人 系统 的 线性 近似 进行 调整 。 这 个 
近似 可 以 在 固定 的 平衡 点 上 或 者 实际 参考 轨迹 附近 获 
得 ， 分 别 产 生 了 一 个 线性 时 不 变 或 者 线性 时 变 系统 。 
虽然 (可 能 时 变 的 ) 稳定 反馈 和 矩阵 的 存在 性 由 这 些 
线性 近似 的 可 控 性 得 到 保证 ， 该 方法 的 有 效 性 实际 上 


器 状态 的 ) 扩展 系统 同时 实现 输入 -输出 解 看 以 及 精 


只 是 局 部 的 ， 且 其 收敛 区 域 同 时 依赖 于 给 定 的 轨迹 以 
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及 所 设计 的 线性 反馈 的 鲁 棒 性 。 

这 里 还 应 该 指出 ， 这 样 一 种 轨迹 跟踪 问题 的 控制 
方法 也 适用 于 具有 柔性 连 杆 的 机 器 人 。 一 旦 逆 运 动 学 
问题 得 到 解决 (对 柔性 连 杆 情况 来 说 ， 这 通常 导致 
一 个 无 关 的 解 ) ， 形 如 式 (13.53) (或 分 别 用 连 杆 挠 
度 6 和 挠 率 5 PHC g 和 4 得 到 的 式 (13.51) ) 的 控 
制 器 可 被 直接 应 用 。 


13.1.5 扩展 阅读 


这 一 部 分 包括 了 本 章 中 关于 机 器 人 柔性 部 分 的 主 
要 参考 书目 。 除 此 之 外 ， 我 们 还 列举 出 了 更 多 关于 这 
个 话题 本 书 中 所 没有 提 到 的 参考 书目 。 

早期 对 于 从 机 械 手 柔性 传动 装置 存在 性 中 引起 的 
问题 的 研究 可 以 追溯 到 参考 文献 [13.1，2]， 首 个 
实验 结果 来 自 GE P-50 机 械 臂 。 涉 及 机 械 臂 设计 及 其 
和 柔性 元 素 评价 的 相关 机 械 考虑 可 以 在 参考 文献 
[13.3] 中 找到 。 

关于 机 械 臂 动力 学 建 模 中 包含 关节 柔性 的 最 早 研 
究 之 一 来 自 于 参考 文献 [13.4]. 13. 1.1 中 对 模型 结 
构 的 详细 分 析 来 源 于 参考 文献 [13.5] ， 一 些 更 新 来 
源 于 参考 文献 [13.6]。 参 考 文献 [13.7] 介绍 了 推 
导出 简化 模型 的 简化 假设 。 参 考 文献 [13.8] 分 析 
了 安装 在 驱动 连 杆 上 的 特殊 电动 机 。 有 限 弹性 关节 导 
致 奇异 摄 动 的 动力 学 模型 的 观察 是 在 参考 文献 
[13, 9] 中 被 首次 提 到 。 自 动 生成 弹性 关节 机 絮 人 的 
动力 学 模型 的 符号 操作 程序 很 早 在 参考 文献 
[13.10] 中 被 提出 。 

在 13. 1.2 节 中 提 到 的 逆 动 力学 计算 可 以 追溯 到 
参考 文献 [13.11 ] 。 参 考 文献 [13.6] 强调 了 如 
Modelica 等 程序 在 逆 动 力学 数值 计算 中 的 运用 。 

最 初 的 特殊 控制 设计 是 基于 离散 的 线性 控制 器 
的 ， 参 见 参考 文献 [13. 12] 和 [13.13] 中 的 例子 ， 
其 中 用 到 了 每 个 弹性 关节 上 的 四 阶 动力 学 。 但 是 , 具 
有 被 证 明 的 全 局 收敛 特性 的 方案 后 来 才 出 现 。 

在 13.1.3 节 中 具有 常 重力 补偿 的 PD 控制 器 出 现 
在 参考 文献 [13.14] 中 。 这 个 方法 也 适用 于 参考 文 
献 [13.15] 中 具有 柔性 连 杆 的 机 器 人 的 情况 。 参 考 
文献 [13.16] 和 [13.17] 分 别提 出 了 具有 在 线 重 
力 补偿 的 调节 控制 的 两 种 形式 。 这 两 种 控制 法 则 都 可 
以 扩展 到 参考 文献 [13.18] 和 [13.19] P H) EE 
儿 柔 顺 方案 中 去 。 参 考 文献 [13.20] 提出 了 一 种 基 
于 能 量 成 型 的 一 般 校 准 方程 组 。 在 缺乏 重力 信息 时 ， 
参考 文献 [13.21] 提出 了 一 种 具有 半 全 局 稳定 性 的 
PID 调节 器 ， 而 参考 文献 [13.22] 提出 了 一 种 全 局 


方案 。 

一 种 用 于 校准 (和 跟踪 ) 的 全 状态 反馈 设计 的 
展示 用 到 了 参考 文献 [13.23] 中 的 观点 。 这 些 年 来 
关节 转 矩 反馈 尤其 被 关注 ， 通 过 传动 轴 上 的 扭转 传 感 
器 的 布置 532 ， 或 从 谐 波 驱动 5 到 它们 在 实现 鲁 
棒 控 制 性 能 中 的 运用 ! 2 。 

参考 文献 [13.7] 首次 提出 了 弹性 关节 机 器 人 
的 简化 模型 总 可 以 通过 静态 状态 反馈 实现 反馈 线性 
化 。 一 个 更 早 的 关于 具体 机 器 人 运动 学 的 类 似 结果 可 
以 在 参考 文献 [13.27] 中 找到 。 参 考 文献 [13.28] 
探究 了 反馈 线性 化 方法 的 离散 时 间 的 实现 ， 而 它 的 鲁 
棒 性 由 参考 文献 [13.29] 分 析 。 参 考 文献 [13.30] 
分 析 了 和 殊 弹 性 关节 情况 下 的 反馈 线性 化 以 及 输入 - 输 
"hg, md xd [13.31] 则 讨论 了 具有 混合 > 
型 关节 (一些 为 刚性 一 些 为 弹性 ) 的 机 器 人 的 情况 。 
相同 的 导致 输入 -输出 解 厅 和 线性 化 的 逆 控 制 观点 已 
经 被 成 功 运 用 到 解决 柔性 连 杆 机 器 人 的 关节 轨迹 追踪 
问题 中 了 !2 2 。 

对 于 具有 弹性 关节 的 机 器 人 的 一 般 模型 来 说 ， 
动态 反馈 的 运用 在 参考 文献 [13.33] 中 首次 被 提 
出 。 一 项 对 于 因为 忽略 电动 机 - 连 杆 惯性 耦合 (HI 
没有 通过 静态 反馈 被 线性 化 的 机 器 人 ) 而 引入 的 误 
差 的 比较 研究 在 参考 文献 [13.34] 中 被 提 到 了 。 
参考 文献 [13.35] 提出 了 构建 动态 线性 反馈 的 一 
般 性 算法 。 

其 他 可 用 于 轨迹 追踪 的 控制 方案 设计 (在 
13.1.4 节 中 都 没有 被 提 及 ) ， 是 基于 反 推 或 者 被 动 的 
奇异 摄 动 。 参 考 文 献 【13. 36] 和 参考 文献 [13.37] 
提出 了 基于 双 时 间 尺 度 分 离 特性 的 非 线性 控制 器 。 这 
些 修正 控制 器 是 奇异 摄 动 模 型 形式 的 结果 ， 且 在 关节 
刚度 较 大 的 情形 下 应 当 作为 首选 ， 因 为 它们 在 极限 情 
况 下 不 会 产生 高 增益 效应 。 反 推 是 建立 在 认为 关节 弹 
性 转 矩 3 或 者 电动 机 位 置 '* 引 是 一 个 被 用 于 控制 
连 杆 方程 组 的 中 间 虚 构 输 入 的 基础 上 的 ， 然 后 设计 出 
在 电动 机 方程 组 中 的 真实 转 矩 输入 ， 从 而 实现 之 前 中 
间 输 入 的 参考 行为 。 这 种 设计 的 主要 优点 是 它 可 以 较 
容易 地 转换 成 自 适应 形式 。 对 于 弹性 关节 机 器 人 自 适 
应 控制 的 结果 包括 了 高 增益 (近似 ) DRO 和 参 
考 文献 [13.41] 中 得 到 的 整体 (但 非常 复杂 的 ) 
解 ， 二 者 都 仅 使 用 简化 动力 学 模型 进行 分 析 。 而 且 ， 
基于 滑 移 模 式 技术 的 鲁 棒 控 制 方案 在 参考 文献 
[13.42] 中 被 提出 ， 而 基于 对 重复 任务 的 迭代 学 习 
方法 在 参考 文献 [13. 43] 提出 。 

不 同 的 状态 观测 装置 已 经 被 列 出 ， 从 参考 文献 
[13.44] 中 的 近似 观测 器 到 参考 文献 [13.45] 和 
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[13.5] 中 的 精确 观测 装置 ， 其 中 一 种 基于 估计 状态 
的 跟踪 控制 器 也 被 测试 了 。 在 所 有 的 实例 中 ， 连 杆 位 
置 或 连 杆 位 置 及 速度 参数 都 是 假定 的 。 最 近 ， 在 稳健 
状态 建立 中 ， 电 动机 位 置 以 及 连 杆 加 速度 的 运用 已 经 
成 为 了 一 个 可 行 的 替代 方案 8.4 。 

最 后 ， 具 有 弹性 关节 的 机 器 人 的 约束 任务 中 的 力 
控制 问题 已 经 通过 运用 一 种 奇异 摄 动 技术 3， 
逆 动 力学 方法 3 或 者 一 种 自 适应 策略 RIT 
解决 。 


具有 柔性 连 杆 的 机 器 人 


手臂 的 柔性 是 一 个 动力 学 行为 ， 在 其 中 动能 和 弹 
性 势能 进行 相互 转换 。 动 能 是 存储 于 运动 惯性 中 ， 而 
势能 则 存储 于 变形 组 件 中 。 和 柔性 连 杆 的 所 有 组 件 既 具 
有 惯性 特征 ， 又 具有 和 柔顺 特征 。 和 柔性 的 表现 形式 是 机 
械 振 动 以 及 静态 挠 度 ， 使 得 机 械 臂 的 运动 控制 变 得 极 
其 复杂 。 如 果 用 于 解决 震荡 所 花 的 时 间 相 对 于 总 体 任 
务 周期 所 占 比例 较 大 ， 那 么 柔性 在 手臂 设计 中 将 作为 
一 个 主要 考虑 因素 。 


13. 2 


13.2.1 设计 问题 


我 们 将 用 模块 化 方法 来 解决 这 些 问题 ， 将 连 杆 柔 
性 和 关节 和 柔性 区 别 开 来 。 连 杆 柔 性 的 首要 问题 是 解决 
柔 度 和 惯性 的 固有 空间 分 布 问题 ， 这 两 种 效应 可 能 同 
时 作用 于 材料 的 同一 部 位 。 机 械 臂 的 连 杆 通常 可 以 通 
过 增加 结构 质量 或 者 通过 提高 材料 的 性 能 或 在 连 杆 上 
的 分 布 来 得 到 强化 。 在 某 些 点 连 杆 可 以 被 当做 刚体 处 
理 。 设 计 者 必须 认识 到 由 沉重 的 刚性 连 杆 和 柔性 关节 
组 成 机 械 臂 可 能 比 带 有 更 高 连 杆 柔 度 和 更 少 惯性 的 轻 
质量 手臂 更 具有 动态 柔性 。 这 个 结论 是 由 关节 驱动 器 
被 锁定 情况 下 运动 第 一 个 柔性 运动 模式 的 固有 频率 来 
预测 的 ， 该 频率 可 近似 表达 为 : 
k eff 
La 
WP, hg ERTIES BL, Lg BEAN FARA TERR TE 
弹性 关节 的 情况 下 ，Ar 和 LET DAS EPA B9 SE 5 95 
性 参数 和 质量 特性 直接 获得 。 这 些 等 效 量 适用 于 一 个 
简单 的 弯曲 梁 ， 例 如 ， 将 导致 一 端 固 支 男 一 端 自 由 的 
边界 条 件 ， 并 将 被 选 为 生成 固有 频率 的 一 个 很 好 的 近 
似 值 。 固 有 频率 可 以 通过 查阅 振动 手册 获得 ， 在 该 例 
中 w =3.52 VBAmF。( 这 些 变量 在 式 (13.55) 和 
st (13.56) 中 用 到 ， 其 定义 在 后 文中 。) 几何 尺寸 
更 复杂 的 组 件 可 以 通过 多 种 方法 计算 获得 固有 频率 ， 


(13.54) 


w = 


包括 在 13.2.2 部 分 中 讨论 过 的 建 模 的 传递 矩阵 法 。 
当 固 有 频率 足够 低 以 至 于 它 将 干扰 基于 刚体 模型 假设 
的 控制 絮 的 设计 时 ， 机 械 臂 就 应 当 被 视 为 柔性 的 。 当 


闭环 极点 的 幅 值 小 于 约 寺 ol 时 ， 用 于 和 柔性 连 杆 上 单 


关节 的 常见 的 比例 -微分 (PD) 控制 法 只 能 在 闭环 设 
计 中 获得 足够 的 阻尼 ! ”1 。 

材料 机 械 性 能 的 关键 之 处 现在 是 有 序 的 。 在 某 
些 情况 下 静态 形变 的 影响 充分 表现 在 一 个 组 件 上 ， 
然而 在 另外 一 些 情况 下 变形 和 质量 的 真实 分 布 特性 
及 其 动力 学 特性 必须 被 加 以 考虑 。 一 个 被 垂直 于 长 
轴 的 力 / 以 及 力矩 M 作用 的 长 条 形 结构 件 会 受到 弯 
曲 。 静 态 弯 曲 将 轴 向 位 置 x 处 的 力矩 和 位 移 w 联系 
起 来 


aw 
ax? 
SUP, 是 材料 的 弹性 模 量 ; I(x) 是 横 截 面 中 性 轴 
的 面积 惯性 矩 。 任 何 一 点 处 的 找 度 可 以 通过 对 该 等 式 
从 参考 点 到 期 望 点 进行 积分 来 获得 ， 比 如 说 连 杆 
末端 。 

这 是 当 质 量 和 弹性 相互 独立 时 和 柔顺 度 的 一 个 描 
述 。 如 果 质 量 分 布 在 整个 梁 上 ， 其 材料 质量 密度 每 单 
位 体积 为 p， 则 必须 合并 时 间 上 +， 因此 


O w(x,) | a x 9 w(x,t) 
m(x) ar 5 (EK ) ox? Jeo 


M(x) 2 El(x) (13. 55) 


(13. 56) 
这 里 m(x) 代表 的 是 单位 长 度 的 质量 密度 ， 综 合 了 > 
处 的 材料 特性 以 及 横断 面积 。 假 设 在 这 个 被 称 作 伯 努 
利 - 欧 拉 方 程 的 等 式 中 ， 包 含 了 该 梁 横 截面 处 切 形变 
及 转动 惯量 的 最 小 的 影响 ， 这 些 对 于 长 梁 来 说 是 有 效 
的 。 铁 木 辛 柯 (Timoshenko) 深 模 型 放宽 了 这 些 假 
Be, 但 本 文 并 不 做 讨论 。 
如 果 长 梁 轴 上 作用 了 转 矩 7 的话 ， 扭 转角 为 9 的 
扭转 变形 就 会 出 现 ， 在 静态 条 件 下 有 


(13.57) 


式 中 ,6G 为 材料 的 剪 切 模 量 ; 为 相对 梁 中 性 轴 的 极 
惯性 矩 。 同 样 ， 分 布 质量 的 增加 以 及 考虑 到 动力 学 ， 


产生 了 一 个 具有 时 间 和 空间 独立 变量 的 偏 微分 方程 
moo (13.58) 
ac ox? 


式 中 , u (x). HARARE A EAR HE Zh 
(13.58) 还 适用 于 连 杆 ， 相 对 于 比 连 杆 拥 有 更 小 转 
动 惯性 矩 的 细 长 轴 来 说 ， 最 重要 的 是 它 导 致 了 由 式 
(13. 57) 给 出 的 扭转 的 静态 柔顺 效应 。 

拉 伸 和 压缩 效果 也 应 该 被 承认 ， 尽 管 他 们 往往 是 
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最 次 要 的 。 这 里 ， 伴 随 着 沿 x 方向 的 挠 曲 ， 部 件 长 轴 


将 会 产生 形变 


FL 
b= ce, (13. 59) 
以 及 动力 学 柔性 方程 
FE QE 
这 = 下 一 3 13. 60 
ot^ Ox” ( ) 


注意 到 这 些 效应 都 是 特例 ， 其 更 为 普遍 的 情况 是 弹性 
组 件 受 到 加 速度 和 外 载荷 影响 ,尤其 对 于 长 轴 类 组 
件 。 同 样 的 普遍 现象 适用 于 关 闻 结构 (例如 轴承 和 
Wu) 以 及 传动 系统 组 件 ( 如 齿轮 和 缆 线 )。 这 些 
组 件 在 结构 设计 上 的 功能 约束 可 能 更 加 严格 ， 因 而 会 
限制 设计 者 使 用 更 多 材料 以 提高 组 件 的 刚性 。 在 这 些 
£ 


形 将 会 导致 该 组 合 的 性 能 较 差 。 具 有 较 少 惯性 及 较 低 
性 的 连 杆 将 会 提高 最 低 固 有 频率 。 因 此 连 杆 和 关节 
的 设计 必须 相互 结合 起 来 。 

柔性 仅仅 只 是 连 杆 设计 的 若干 约束 其 中 之 一 。 
通过 上 述 讨 论 可 看 出 ， 静 态 柔 顺 度 也 是 一 项 约束 。 
屈曲 和 强度 是 限制 某 些 设计 参数 的 两 项 更 需要 考虑 
的 问题 。 已 经 表明 柔性 是 典型 手臂 设计 制度 中 的 首 
BELGE) ， 管 状 梁 弯 曲 刚度 的 一 个 简单 优化 阐明 
了 忽略 屈曲 的 错误 做 法 。 如 果 在 总 质量 不 变 的 约束 
下 ， 将 管子 半径 改变 以 至 弯曲 刚度 达到 最 大 值 ， 那 
么 半径 将 无 限 增 大 ， 从 而 产生 一 个 缺乏 稳健 性 的 具 
有 无 穷 小 厚度 和 无 穷 大 半径 的 薄 壳 结构 。 真 正 的 限 
制 条 件 变 成 了 在 外 加 载荷 的 微 扰 情况 下 管子 的 局 部 
届 曲 。 一 片 薄 金属 片 在 受到 挤 压 时 可 以 解释 这 种 行 
为 。 强 度 是 另外 一 个 适用 约束 。 不 同 材 料 的 强度 不 
同 ， 尤 其 表现 在 其 应 力作 用 下 的 弹性 极限 或 疲劳 强 
度 上 。 一 个 刚性 足够 的 组 件 可 能 由 于 应 力 而 损坏 ， 
尤其 在 应 力 集中 点 处 。 

在 克服 柔性 尤其 是 连 杆 柔性 的 方法 介绍 中 ， 完 
不 同 的 操作 和 设计 方法 也 需要 被 考虑 进来 ， 尽管 它们 
并 不 是 处 理 问题 的 核心 。 弹 性 模 量 将 应 力 和 应 变 联 系 
起 来 ,但 实际 上 应 变 率 有 时 候 是 一 个 相对 概念 ， 它 会 
提供 增 大 关节 阻尼 或 者 基于 控制 的 阻尼 的 结构 阻尼 。 
复合 材料 本 质 上 有 更 大 的 固有 阻尼 。 阻 尼 可 以 通过 被 
动 减 震 处 理 来 增 大 ， 通 过 约束 层 阻 尼 有 特别 明显 的 效 
FRB) | BEAR AY LA Ae Hes Be) 。 一 种 
可 行 的 办 法 被 称 为 撑 臂 ， 可 以 结合 元 余 驱 动 来 为 柔性 
臂 提 供 大 工作 空间 ， 这 种 方法 在 确定 大 机 械 臂 的 固定 
结构 之 后 可 以 提供 总 运动 和 较 小 的 精确 工作 空间 ， 如 
参考 文献 [13.55] 所 述 。 

上 述 内 容 暗示 了 和 柔性 


= 


H> 


总 是 由 手臂 的 运动 部 位 产生 


的 。 但 是 ,手臂 基 座 本 身 也 可 能 是 柔性 的 重要 来 源 。 
如 果 基 座 是 固定 的 ， 那 么 基 座 柔性 的 分 析 几 乎 和 手 
辟 上 弹性 连 杆 的 分 析 同 等 重要 。 但 是 如 果 手 臂 是 安 
装 在 运动 物件 上 ， 轮 子 或 者 轨道 就 可 能 是 柔性 的 来 
源 ， 那 么 对 这 些 新 组 件 的 经 验 分 析 可 能 是 最 好 的 解 
决 办 法 。 这 种 运动 物件 还 可 能 是 船 、 飞 机 或 者 空间 
飞行 咒 。 这 样 就 不 会 有 和 惯性 参考 系 的 弹性 连接 ， 
这 就 需要 对 方法 进行 一 些 根本 改变 。 这 些 改变 并 不 
是 未 经 考察 的 ， 某 些 情 况 下 仅仅 是 以 下 几 种 方法 的 
简单 扩展 。 


13.2.2 ”柔性 连 杆 臂 的 建 模 


杆 件 柔性 的 数学 建 模 以 牺牲 精确 度 来 获得 使 用 的 
简便 性 。 因 此 关键 点 是 确定 那些 需要 被 精确 表达 的 重 
要 效应 。 这 里 采用 的 方法 是 假定 具有 小 阻尼 的 线性 弹 
性 。 旋 转运 动 必须 具有 合适 的 角速度 以 便 离 心 刚度 可 
以 被 忽略 。 一 般 会 假定 具有 小 挠 度 。 对 于 绝 大 部 分 机 
器 人 装置 来 说 这 些 假 设 都 是 合理 的 ， 但 是 更 多 特殊 情 
况 下 这 些 假定 不 成 立 ， 因 此 需要 重新 评估 假设 ， 以 及 


更 复杂 的 建 模 方法 。 

考察 四 种 模型 类 型 

1) 集 总 元 件 模 型 ， 具 有 和 柔顺 度 或 惯性 ， 但 在 同 
一 组 件 中 二 者 不 兼 具 。 


2) 有 限 元 模型 ， 仪 将 简要 讨论 。 

3) 假设 模 态 模型 ， 将 包括 非 线 性 动力 学 行为 。 

4) 传递 矩阵 模型 ， 混 合 了 柔顺 度 及 惯性 的 真实 
分 布 ， 因 此 为 无 限 维 的 柔性 连 杆 臂 。 

由 于 篇 幅 有 限 ， 这 里 只 进行 初步 讨论 ， 但 应 使 读 
者 能 够 了 解 其 中 的 一 个 或 多 个 选择 。 

对 于 和 集 总 元 件 ， 我 们 可 以 基于 运动 学 基础 (第 
一 章 ) 中 的 刚体 变换 矩阵 4, 建立 刚体 运动 学 的 模型 。 
这 个 4 x4 阶 用 来 描述 位 置 的 齐 次 变换 矩阵 同样 可 被 
用 来 描述 挠 度 。 假 定 微小 运动 以 及 静态 行为 (RA 
略 组 件 质量 ) ， 则 这 个 由 弹性 弯曲 、 扭 转 和 压缩 所 引 
起 的 变换 矩阵 为 


i i 
1 = oy; F y; — oy; M, 
i i 
Agri Fyi + Agu; M; 1 
E, = . . : 
i i i 
Agri zi — Coy My; oM 
0 0 
i i i 
一 Qeori + Coy My; ac; Py 


- as M y; Q gg Fy, Oc M, (13.61) 
1 O yy; F + oc; MS; 
0 1 


式 中 ，acu 是 压缩 系数 ， 位 移 / 力 ; ar 是 扭转 系数 ， 角 
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E/E; ao 是 弯曲 系数 ， 角 度 / 力 ; ar 是 弯曲 系 
数 ， 角 度 / 力 矩 ; ax 是 弯曲 系数 ， 位 移 / 力 ; ar 是 
弯曲 系数 ， 人 位移/ 运动; ;是 在 坐标 系 j 中 沿 X 方向 
连 杆 i 末端 所 受 的 力 ; 到 是 在 坐标 系 j rit Y 方向 连 
杆 i 末端 所 受 的 力 ; 瑟 是 在 坐标 系 j 中 沿 Z 方向 连 杆 
i 末端 所 受 的 力 ; Ms 是 在 坐标 系 j 中 沿 X 方 向 连 杆 i 
末端 所 受 的 力矩 ;M3 是 在 坐标 系 j 中 沿 Y 方 向 连 杆 i 
末端 所 受 的 力矩 ;1 是 在 坐标 系 j 中 沿 Z 方 向 连 杆 i 
末端 所 受 的 力矩 。 

上 面 所 例 举 的 系数 依赖 于 组 件 的 结构 ， 且 对 于 
有 具 有 简单 材料 强度 的 细 长 梁 来 说 很 容易 得 到 。 在 另 
外 一 些 情况 下 ， 有 限 元 模型 或 者 经 验 数据 可 能 更 加 
适用 。 

对 于 NN 个 组 件 ( 连 杆 或 者 关节 ) 变形 部 分 或 者 
非 变形 部 分 的 交 蔡 变换 将 生成 一 个 手臂 末端 的 位 置 矢 
量 (EOA): 


o coc c 


p = (AEA,E,…AE.A., Eitt AEn) 


1 
(13.62) 


如 果 无 质量 元 件 连 接 了 刚性 集中 质量 ， 那 么 我 们 
便 可 以 得 到 一 个 线性 空间 模型 ， 正 如 参考 文献 
[13.56] 中 所 描述 。 伺 服 控制 关节 也 可 以 加 入 到 这 
个 模型 中 。 这 个 分 析 接 下 来 要 考察 由 关节 运动 产生 的 
弹性 组 件 的 变形 以 及 在 运动 链 末 端 由 于 刚体 惯性 引起 
的 力 和 力矩 。 参 考 资料 主要 关注 于 仅 有 两 个 惯量 作用 
于 链 的 每 个 末端 的 特殊 情况 ， 但 事实 上 这 种 方法 也 可 
以 很 容易 地 扩展 到 惯量 存在 于 链 中 部 的 情况 。 该 结果 
将 被 表达 为 关于 每 个 惯量 的 六 个 线性 二 阶 方程 组 ， 以 
及 关于 每 个 关节 的 一 个 一 阶 方程 。 

如 果 和 柔顺 性 和 惯性 特性 均 被 认为 是 在 遍布 于 同 
一 元 件 中 的 ， 那 么 在 前 章 所 提 到 的 关于 弯曲 、 扭 转 
和 压缩 的 偏 微分 方程 就 必须 被 引入 使 用 。 仍 考虑 线 
性 情况 ， 这 些 方程 组 的 通 解 可 以 在 每 个 和 其 他 组 件 
毗邻 的 组 件 中 得 到 ， 即 偏 微分 方程 的 边界 条 件 。 对 
这 些 线 性 方程 组 进行 简单 的 拉 普 拉 斯 变换 至 频 域 ， 
然后 将 边界 条 件 分 解 为 矩阵 向 量 积 ， 这 样 就 获得 了 所 
谓 的 传递 矩阵 法 (TMM) 吕 1。 这 个 方法 可 以 有 效 地 
应 用 于 一 般 的 弹性 力学 问题 中 ， 尤 其 可 以 解决 柔性 臂 
问题 3 。 

变换 矩阵 可 以 将 手臂 上 两 个 位 置 处 的 变量 与 基于 
模型 复杂 性 的 变量 数量 联系 起 来 。 对 于 图 13.9 中 所 
示 梁 的 平面 弯曲 变形 来 说 


3 


-W 负 位 移 
yi 角度 
a5) M | | 力矩 mist 
V 1 8971 位 置 1 处 
(13. 63) 
式 中 7 是 一 个 合适 的 元 件 传递 矩阵 。 
0 端 IE 
y x 
M 
z V T 


4139 棍 曲 转移 矩阵 的 状态 矢量 


如 果 这 个 元 件 是 简单 的 旋转 弹簧 ， 其 弹簧 常数 是 人， 
阻尼 常数 是 46， 那么 旋转 角 9 就 与 力矩 有 关 ， 这 个 关系 
可 以 通过 一 个 微分 方程 确定 ， 其 拉 普 拉 斯 域 可 表达 为 : 

M = -L(k8 € b ) =kO(s) +bsO(s) =M, =M, 


W,zW, 
V; =V, 
P =p ~O(s) = 办 一 
注意 到 组 件 中 唯一 的 变量 是 与 力矩 有 关 的 角度 。 变 换 
矩阵 通常 用 零 初始 条 件 表达 ， 并 利用 
1 0 0 0 
0 CM TN. 
T=C(iw) = k+b(iw) 
0 0 1 0 
0 0 0 1 


此 函数 与 方程 (13.64) 中 的 关节 控制 器 具有 相同 
形式 。 


梁 模 型 复杂 得 多 ， 


欧 拉 - 伯 努 利 模型 给 出 了 


Co le, ac, alc, 
B'c,/l é5 ac,/l ac, 

B= (13. 64) 
B'c,/a  B'le,/a Co le, 
c/al B'c,/a Bo e, 


RP, Be lu (ED ; a & P/(EI) ; co 是 (cosh + 
cosB)/2; cj 是 (sinhB + sinB)/(2B); cy 是 (coshB - 
cosB)/ (2B?) ; cs 是 (sinhB — sinB)/(26°); u ERZ 
HE. o 是 振动 圆 频 率 ; BEB, 7 是 横 截 面 的 
惯性 矩 。 

其 中 空间 变量 已 经 转变 为 拉 普 拉 斯 空间 变量 ， 
但 不 再 明确 出 现 。 拉 普 拉 斯 时 间 变 量 还 继续 存在 ， 并 
且 被 表示 为 *， 或 者 被 表示 为 频率 变量 e = is, HB 
i= V -II。 另 一 个 简单 的 平面 模型 所 需要 的 传递 和 矩阵 
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如 下 。 
对 于 一 个 旋转 了 e 角度 的 平面 
1/cosp 0 0 0 
0 10 0 
A= 0 00 0 (13. 65) 
m œw singtanp 0 0 cos 
式 中 ,m. 是 从 弯 折 角 到 手臂 末端 的 所 有 外 部 质量 
和 。 这 是 忽略 了 压缩 弹性 模 量 所 得 到 的 一 个 近似 结 
果 。 当 这 些 元 件 被 压缩 时 ， 它 们 在 一 定 程度 上 相当 于 
增加 了 质量 。 
dU déc M É 


1 0 0 
0 1 0 0 
R= 2 
-mol/2 -lo +ma"l/2 1 1 
ma - ma’ l/2 0 1 
(13. 66) 
式 中 , m 表示 物体 质量 ,7 表示 对 一 条 通过 质心 并 且 
垂直 于 手臂 平面 的 轴 的 转动 惯量 ，/! 表示 质量 的 长 度 
(连接 点 位 置 i 和 位 置 i+1 之 间 的 距离 ) L2 表示 从 
CLE i 到 物体 质心 的 距离 。 


对 于 一 个 受到 控制 占 控 制 的 关节 来 说 ,传递 函数 
为 (关节 转 矩 /关节 角度 ) =k(iw)。 


1 0 0 0 
0 1 l/k(io) 0 

= (13.67) 
0 0 1 0 
0 0 0 1 


当 结 合 起 来 表示 图 13.10 中 所 示 的 具有 双关 节 的 平面 
手臂 时 ， 这 个 分 析 将 会 生成 一 个 复合 传递 矩阵 ， 它 将 
手臂 两 末端 的 四 个 状态 参量 联系 起 来 。 如 果 知 道 了 两 
末端 的 边界 条 件 ， 就 将 可 以 进行 深入 的 分 析 。 


E 
Ri | 


0 端 


Ag Cs 


图 13. 10 手臂 的 传递 矩阵 表示 


这 个 传递 矩阵 代表 了 参考 文献 [13.59] 中 所 展 

示 的 手臂 ， 图 13. 10 所 示 关 系 式 见 式 (13.68). 
-W -W 
-R,B,R,A,C,B,R, (13. 68) 


V ^ VA 


在 本 例 中 ， 连 杆 左 端 是 固定 的 ， 右 端 是 自由 的 ， 
产生 如 下 关系 式 : 
-W Uy Up Ug Ug -W 
p Ux, Uy Ug Uy y 
"e M = Ua Uy Us Ug M 
VA Uy, Up Ug Way VA 


(e a es = (5) (13.69) 
U3, Ua v h 0 

1M o 为 固有 频率 ， 或 者 若 和 矩阵 较 复杂 则 为 系统 特征 
值 时 ， 这 个 2 x2 矩阵 的 行列 式 必须 等 于 零 。 这 个 结 
论 可 以 通过 数值 研究 给 出 。 考 察 沿 手臂 长 度 方向 的 变 
量 (Ma, AE, KIMIE), KREEK o 
的 值 从 而 得 到 的 特征 函数 。 如 果 边 界 条 件 不 为 零 ， 而 
是 已 知 的 频率 ， 这 样 就 可 以 得 到 系统 的 频率 响应 。 因 
此 波 特 图 可 以 通过 边界 条 件 受 力 得 到 。 内 部 力 可 以 通 
过 一 个 如 参考 文献 [13. 57] 所 述 的 扩展 状态 矢量 来 
处 理 ， 该 矢量 被 应 用 于 参考 文献 [13.51] 所 述 的 手 
臂 中 ， 且 最 近 通 过 参考 文献 【13. 58] 中 的 现代 程序 
技术 得 到 更 新 。 人 快速 傅 里 叶 逆 变 换 (FFT) 将 从 频率 
响应 中 得 到 一 个 时 域 响应 。 

在 时 域内 创建 一 个 状态 空间 模型 很 有 吸引 力 ， 因 
为 它 使 得 我 们 能 够 运用 有 效 的 状态 空间 设计 技术 ， 且 
它 和 进行 着 大 范围 运动 ， 并 受到 离心 力 和 科 里 奥 利 力 
作用 的 手臂 的 非 线性 行为 相 兼容 。 假 设 模 态 法 使 得 这 
样 一 个 模型 可 以 被 有 效 地 构建 起 来 。 这 里 所 讨论 的 都 
是 根据 先前 引入 的 递归 方法 ， 对 参考 文献 [ 13. 60] 
中 所 介绍 的 方程 组 进行 计算 而 得 到 的 。 连 杆 的 柔性 运 
动 必 须 被 表示 为 一 组 基 男 数 的 和 ， 该 基 贞 数 也 被 称 为 
具有 时 变 幅 值 5(+) 的 假设 模 态 (形状 ) d; 


wu) = Lad (a) (13. 70) 


这 些 幅 值 函 数 及 其 导数 便 成 为 了 模型 的 状态 
数 。 兼 容 关 节 角 度 可 变 ， 且 它们 的 导数 也 同样 包含 
中 作为 刚体 状态 参数 。 
基于 一 端 为 固定 边界 条 件 另 一 端 为 自由 边界 条 件 的 模 
态 相 兼 容 。 这 个 方法 通常 用 于 数值 模拟 ， 且 刚体 坐标 
可 以 通过 标准 关节 角度 传感器 直接 测 得 。 如 果 刚 体 坐 
标 系 是 通过 测量 连续 关节 轴 之 间 的 连 线 而 获得 的 角 
度 ， 那 么 手臂 末端 单独 作为 刚体 坐标 系 ， 且 符合 双 国 
支边 界 条 件 。 可 见 这 有 利于 逆 动 力学 计算 。 
柔性 运动 学 和 刚性 运动 学 相 结合 描述 了 手臂 上 每 
个 点 的 位 置 和 速度 ， 并 且 可 以 用 来 表达 动能 .六 和 势能 
7; 这 些 表达 式 被 用 于 保守 形式 的 拉 格 朗 日 方程 中 : 
d 97 97 ， OF 
dt ag, ðq; * 8q, 


-F, (13.71) 
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RP, FEM g, 改 变 时 做 功 的 力 。 


偏转 的 运动 学 同样 可 用 4 x4 阶 传递 矩阵 描述 ， 
但 这 次 假定 模 态 j 被 求 和 ， 以 给 出 连 杆 i 的 位 置 。 
7 Xi ;QD 
hin) = EY XD | 43,79) 
js | zn 
1 0 


DP, xy, yy, 2 REPT i 的 挠 度 对 应 的 模 态 7 分 别 在 
iy Yen ATEN; 6; 是 连 杆 i 的 模 态 j 的 时 变 
幅 值 ，m; 是 用 来 描述 连 杆 i 搁 度 的 模 态 数目 。 
E = (H+ Sem) (3.7) 
jsi 
其 中 
1004 
100 
mer (13.74) 
0010 
0001 
并 且 
0 一 05 0,; ij 
0 0 -09 
M,=| “ IE) 13.05 
-0 Bs 0 z 
0 0 0 


— M 


对 连 杆 进行 积分 可 以 计算 出 杆 件 的 总 能 量 ， 对 所 有 的 
连 杆 求 和 便 可 以 得 到 手臂 系统 的 总 能 量 。 交 换 积分 和 


求 和 的 顺序 可 以 鉴别 关键 的 不 变 参 数 ， 例 如 和 模 态 振 
幅 的 二 阶 导数 相 乘 的 模 态 质量 以 及 和 模 态 振幅 本 身 相 
le nll 
被 分 离 成 与 刚性 变量 和 柔性 变量 相关 的 微分 方程 。 如 果 
刚性 变量 9 是 关节 变量 ， 那 么 就 可 以 得 到 两 组 方程 组 : 
077 87, 


aK | 


dea ( 
2% i pF. 13. 76) 
dt 30, 90, 90, 90, j 

OF a o7 977 
d "| oH ,Ie Peg. (13.77) 
dt aa) 90, 35, 90, 


AF, FAI e 表示 弹性 ; g 
模 态 形状 的 振幅 。 

方程 组 的 模拟 形式 是 通过 组 合 
所 有 二 阶 导数 而 得 到 的 ， 表 示 为 : 


M,.(q) ye 
p. (q) M; | 5 
0 0\f0 
-f p (pJ Mead) +e 


=R(4,4 ,0), 


KEREJ; 6 表示 一 


刚性 和 和 柔性 坐标 的 


(13. 78) 


SUP, 9 是 刚性 坐标 系 中 的 一 一 个 向 量 ， 通 常 是 关节 变 
hi. 6 是 柔性 坐标 系 ; g = [00]; M, 是 刚性 与 柔性 
E 标 中 与 刚性 (i, j=r) 或 柔性 Gi, j-f) 坐标 和 等 
式 相 一 致 的 质量 矩阵 ; N, q) 包含 非 线 性 的 科 里 
奥 利 力 和 离心 力 项 ; Gq) 是 重力 效应 ; Q 是 施加 的 
外 力 , R 是 外 力 与 所 有 其 他 非 保守 力 如 摩擦 力 的 
效果 。 
一 方面 ， 方 程 的 逆 动 力学 形式 为 : 


ee P i °°) 

= s |+ = 

M,,(q) M, ô 0 K, ô 
N(4,4 ) -G(q) (13. 79) 


Q 依赖 于 关节 处 的 向 量 了 或 电动 机 
这 些 效果 的 分 布 形式 为 ; 


B, 
di ni 
式 中 , 了 与 9 同 维度 。 通 过 对 逆 动 力学 方程 进 
新 排序 我 们 得 到 : 


on 
"EL s q.q)* q 
B, -M;)\6 M, 


(13. 81) 
方程 由 等 式 左边 的 一 个 未 知 向 量 和 等 式 右边 预先 
指定 的 刚性 可 解 柔性 坐标 量 排列 而 成 。 当 假定 非 线性 
条 件 与 重力 条 件 对 这 个 即时 柔性 坐标 系 的 影响 很 小 
时 ， 这 个 方程 至 少 近似 正确 ， 虽 然 这 两 者 不 能 同时 得 
知 ， 但 可 以 在 下 一 步 中 估计 得 到 。 
离散 化 柔性 的 一 个 结果 就 是 产生 非 最 小 相位 系统 
特性 。 当 质量 和 和 柔性 使 激励 与 输出 点 相互 独立 时 ， 即 
所 谓 的 非 匹配 情况 时 ， 这 种 现象 也 可 能 发 生 。 这 些 系 
统 的 特征 在 于 初始 运动 与 最 终 运 动 在 一 个 阶 跃 响应 中 
是 符号 相反 的 。 这 就 是 线性 系统 的 一 个 简单 特征 ， 即 
传递 函数 在 坐标 系 右 半 平面 中 有 一 个 零点 。 


13.2.3 控制 


1. 柔性 控制 传感器 

和 柔性 动力 学 的 正确 反应 需要 合适 的 传感器 。 虽 然 

论 上 卡尔 曼 滤 波 器 通过 关节 测量 可 以 观测 到 柔性 连 
PI EE CER RUBRA 
驱动 关节 的 基础 上 。 和 柔性 更 可 靠 的 观测 包括 应 变 计 、 
加 速度 计 和 光学 传感器 。 

梁 结构 单元 的 应 变 是 弯曲 的 直接 表现 ， 它 是 梁 拨 


ux i 


一 般 说 来 ， 
TB, 


(13. 80) 


井 行 重 


度 的 二 阶 空间 导数 ， 如 式 (13.55) 中 所 示 。 现 代 化 
的 半导体 应 变 计 有 高 测量 精度 ， 并 能 产生 一 个 很 好 的 
信 噪 比 。 二 阶 空间 导数 关系 意味 着 一 个 微小 的 位 置 变 
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化 将 导致 读数 上 的 很 大 改变 ， 但 是 一 旦 安装 在 手臂 上 


造 的 驱动 器 并 没有 能 够 有 效 衰 减 这 些 振 动 的 带宽 外 


后 ， 这 便 不 再 是 问题 了 。 更 主要 的 问题 在 于 如 果 没有 


N Ov 


Jj, 但 是 为 小 运动 轴 建 造 的 驱动 器 通 常 可 以 做 到 。 当 
探索 核 废料 清理 方案 时 '* "中 ， 这 个 结论 已 经 在 若 


妥善 保护 的 话 ， 应 变 计 受到 磨损 将 会 有 相对 较 短 的 寿 
命 。 通 过 合适 地 放置 应 变 计 ， 多 种 假定 模式 的 测量 都 
是 可 行 的 。 

挠 度 的 光学 测量 十 分 通用 ， 但 是 受 限 于 目标 测量 
点 与 传感器 之 间 的 干扰 ， 特 别 当 传感器 固定 不 动 时 。 
如 果 传 感 器 安装 在 连 杆 上 ， 这 个 难度 将 会 降低 ， 但 是 
这 样 的 话 光 学 测量 值 通常 会 变 为 传感器 光 轴 转动 量 与 
目标 挠 度 的 复杂 组 合 。 机 器 视觉 能 够 感应 一 个 宽 视 场 
但 精度 通常 很 低 。 可 以 有 多 个 点 被 检测 ， 这 个 在 测量 
多 种 模式 上 是 很 有 用 途 的 。 机 器 视觉 需要 相当 大 的 处 
理 过程 ， 甚 至 需要 增强 目标 或 反光 基准 ， 因 此 采样 率 
相对 于 其 他 控制 模式 就 显得 较 慢 。 

加 速度 计 也 是 很 有 吸引 力 的 传感器 ， 因 为 它们 不 
需要 被 明确 固 结 到 一 个 固定 支架 上 。 微 机 电 系 统 
(MEMS) 加 速度 计 提 供 了 所 需 的 低频 灵敏 度 ， 并 且 
价格 低廉 。 然 而 ， 它 们 受 限于 重力 场 中 方向 的 影响 ， 
这 些 影响 必须 通过 了 解 传感器 的 方向 来 补偿 。 如 果 我 
们 需要 测量 位 置 ， 那 么 加 速度 计 需 要 进行 两 次 积分 因 
而 受到 位 置 测 量 值 偏 移 的 影响 。 因 此 ， 传 感 器 的 组 合 
应 用 是 更 有 效 的 。 例 如 ， 视 觉 传感器 ， 虽 然 相 对 较 
慢 , 但 是 却 能 给 一 个 柔性 物体 末端 位 置 的 直接 信息 ， 
其 可 以 与 加 速度 计 相 结合 ， 其 中 加 速度 计 以 高 采样 率 
给 出 同样 点 的 信息 ， 但 带 有 噪声 与 偏 移 问 题 。 这 两 种 
传感器 的 读数 可 以 与 卡尔 曼 滤波 器 或 其 他 的 组 合 方案 
相 结合 。 

2. 有 关 模 型 阶 次 问题 

我 们 发 现 一 个 柔性 手臂 理论 上 是 无 穷 阶 的 ， 我 们 
应 该 准备 好 处 理 一 些 有 关 模 型 阶 次 的 特定 问题 。 首 要 
问题 可 能 是 由 于 有 限 的 采样 频率 导致 的 图 形 失 真 问 
题 。 我 们 应 当 使 用 抗 锯齿 滤波 器 ， 更 加 有 效 的 是 使 用 
模拟 阻尼 ， 其 可 通过 材料 ， 阻 尼 处 理 或 者 电动 机 的 反 
电动 势 来 为 数字 控制 系统 提供 一 个 固有 阻尼 。 而 一 个 
更 加 微妙 的 问题 是 测量 与 控制 的 溢出 。 

3. 特殊 结构 的 控制 : 宏观 /微观 宛 余 

若干 特殊 装置 已 经 被 提出 来 了 ， 以 提高 柔性 连 杆 
机 械 臂 的 控制 性 能 。 如 上 述 的 非 并 列 问 题 就 是 一 个 恰 
当 的 例子 。 在 某 些 情况 下 ， 仅 使 用 一 套 简单 的 电动 机 
并 不 能 实现 大 范围 的 运动 与 高 精度 。 宛 余 自 由 度 可 被 
用 于 安 观 自由 度 ， 这 种 自由 度 能 够 提供 大 范围 运动 ， 
但 缺乏 内 在 精度 或 准确 度 。 对 于 一 个 较 长 的 手臂 ， 振 
动 是 很 难 被 消除 的 ， 并 且 结 构 精 度 甚至 是 热 漂 移 都 可 
能 超出 极限 。 如 果 总 体 运 动 很 快 完成 ， 残 余 振动 可 能 
保持 下 来 并 且 误 减 的 很 慢 。 为 大 型 轴 的 总 体 运 动 而 建 


PERERA ae EPS BITES, Fl FP Rr 
生 的 惯性 力也 同样 有 利于 构建 与 用 于 控制 的 测量 值 相 
匹配 的 力 ， 假 定 微 手 臂 的 基 座 处 于 微 手臂 与 传感器 位 
EWR. Loper! 和 George! ^ 已 经 表明 基于 多 
自由 度 加 速度 计 的 控制 是 可 行 的 。 它 同样 可 能 激发 那 
些 没有 研究 的 非 预期 模式 。 如 果 所 有 的 6 个 自由 度 都 
被 使 用 ， 那 么 基于 简单 被 动 类 比 的 稳定 性 是 有 可 能 实 
现 的 。 在 贸 接 式微 操作 机 器 人 的 基 座 上 生成 指定 的 力 
是 一 项 很 富有 挑战 性 的 任务 ， 其 需要 一 种 新 形式 逆 动 
力学 问题 的 解 ， 该 逆 运 动 学 问题 解决 了 产生 规定 的 基 
座 力 和 力矩 所 需 的 运动 或 关节 转 和 矩 。 

4. 柔性 连 杆 臂 的 命令 生成 

一 个 柔性 手臂 的 运动 轨迹 可 以 显著 影响 其 柔性 结 
果 。 对 于 柔性 动力 学 的 纯 开 环 预期 已 经 被 用 于 创造 运 
动 轨迹 ， 在 其 中 运动 消除 了 那些 由 于 早期 运动 造成 的 
初期 震荡。 这 种 策略 被 称 为 命令 塑造 。 一 个 更 加 复杂 
的 实现 方法 是 一 条 基于 逆 动 力学 的 真实 轨迹 ， 其 中 刚 
性 和 和 柔性 状态 都 相互 协调 来 达到 状态 空间 中 的 期 望 
点 ， 通 常 是 一 个 静态 平衡 点 。 弹 性 模型 的 高 阶 由 于 非 
并 列 系 统 的 非 最 小 相位 特性 而 被 进一步 复杂 化 ， 且 无 
关 的 道 运 算 对 于 产生 可 物理 实现 的 运动 轨迹 是 必 
要 的 。 


LL 


对 间 延 时 命令 塑造 是 参考 文献 【13. 66. 67] 中 
介绍 的 无 差 拍 控制 的 另 一 种 形式 。 它 可 以 被 描述 为 一 
个 由 图 13. 11 中 所 描述 的 简单 脉冲 响应 构成 的 有 限 脉 
冲 响 应 滤波 器 ， 它 可 以 由 一 个 单 脉冲 输入 生成 具有 合 
适 的 时 长 和 振幅 的 少量 (通常 为 两 个 或 四 个 ) 输出 
脉冲 。Singer 和 Seering ^99 以 及 Singhose ^ 9! f ^ 
展 ， 在 商标 Input Shaping 下 已 经 产生 了 稳健 性 更 好 的 
种 类 。 稳 健 性 是 通过 采用 更 多 的 输出 脉冲 和 对 输入 脉 
冲 间隔 的 合适 选择 而 得 到 增强 的 。 最 佳 任意 延 时 
(OAT) 滤波 器 呈 “四 将 这 种 选择 简化 为 一 个 关于 线 
性 振动 的 简单 公式 ， 线 性 振动 取决 于 这 些 模 式 的 固有 
频率 和 阻尼 比 以 从 响应 中 被 消除 。 图 13. 12 说 明了 其 
实施 的 简便 性 ， 其 中 滤波 器 参数 和 模式 参数 之 间 的 关 
系 为 


系数 1 =1/M 
系数 2 = - (2coso,T,e "1 )/M 
系数 3 = (e7) /M 


-LonT = onl, 
M =1 —2cosw, Te "Ta +e on 


o,=0, V1 -f = 阻尼 固有 频率 
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o, = 无 阻尼 固有 频率 
“= 阻尼 比 
T, = 时 间 延 迟 选择 ,采样 整数 =A (13.82) 


| 0 时 间 


三 项 指令 整形 
器 的 单 脉冲 


图 13. 11 振动 系统 中 整形 器 的 脉冲 响应 及 效果 。 
时 间 由 内 采样 时 间 7, UT, 进行 标准 化 ， 
使 得 A =T,/T, 为 整数 


输入 系列 


延迟 4 


延迟 24 


图 13. 12 命令 成 形 算法 方块 图 


我 们 注意 到 ， 这 里 的 等 式 是 面向 于 固定 采样 间隔 
的 数字 系统 ， 从 而 滤波 器 的 时 间 延 迟 被 调整 到 采样 间 
隔 的 一 个 整数 倍 。 命 令 塑造 已 经 被 广泛 应 用 于 柔性 系 
统 中 ， 包 括 磁 盘 驱 动 器 、 起 重 机 ， 以 及 大 型 的 机 器 人 
手臂， 例如 图 13. 13 中 所 示 的 CAMotion 等 。 注 意 到 
这 个 例子 包含 了 一 个 柔性 的 传动 皮带 ， 有 效 的 柔性 关 


节 ， 以 及 遵守 最 低 模 式 准则 的 柔性 连 杆 ， 此 模式 由 
OAT 滤波 器 抑制 。 


图 13. 13 命令 成 形 的 大 型 柔性 连 杆 臂 


命令 塑造 的 自 适 应 形式 也 已 经 得 到 了 证 实 。 参 考 
文献 [13.72] 展示 了 一 个 面向 重复 动作 的 应 用 形式 。 


we 柔性 手 
臂 的 逆 动 力学 需要 大 量 系统 知识 。 一 个 合适 模型 的 设 
计 已 经 在 上 面 讨论 过 了 。 例 如 一 一 个 假设 模 态 模型 ， 如 
果 刚 性 坐标 系 不 是 关节 角度 ， 而 是 连接 关节 轴 的 直线 
之 间 的 角度 (这 里 假定 关节 是 旋转 的 ) ， 则 其 能 够 很 
好 地 适应 这 个 逆 动 力学 过 程 。 在 这 种 情况 下 ， 手 臂 末 
端的 预期 运动 可 以 仅 用 刚性 变量 来 表达 ， 即 柔性 关节 
TOL EHISIRHBIIAER qu, WIN, BURNER 
能 够 从 由 已 知 刚体 位 置 与 速度 所 驱动 的 二 阶 方程 组 中 
获得 。 余 下 的 困难 则 是 系统 的 不 稳定 零 动 态 

为 了 介绍 的 目的 ， 这 里 仅 对 线性 情况 仿照 参考 广 
献 [13.73] 进行 处 理 。 首 先 ， 刚性 坐标 系 和 它们 的 
微分 可 以 从 期 望 的 手臂 末端 运动 轨迹 中 得 到 。 和 柔性 方 
程 被 分 为 因果 稳定 零点 与 非 因果 的 不 稳定 零点 ， 而 稳 
定 的 逆 问 题 已 经 及 时 得 到 了 解决 。 实 际 上 运动 响应 在 
力矩 输入 之 后 做 出 响应 。 然 而 计算 输入 是 响应 量 而 力 
和 矩 被 作为 输出 量 进 行 计算 ， 因 此 在 解决 逆 因 果 部 分 时 
没有 违反 物理 定律 ， 该 逆 因 果 部 分 在 最 后 时 刻 开始 ， 
此 时 弹性 坐标 系 已 经 被 指定 为 零 ， 并 延续 至 初始 时 间 
以 及 之 前 。 事 实 上 准确 的 解 由 负 无 穷 大 (在 此 处 逆 因 
果 解 退化 ) 延伸 到 正 无 穷 大 (在 此 处 因果 解 退化 ) 。 
对 于 真实 的 动力 学 问题 ， 必 要 的 输入 时 间 仅 比 手臂 末 
端的 运动 时 间 略 多 一 些 ， 因 为 在 两 个 方向 上 零点 通常 
都 远离 原点 。 如 果 手 臂 末端 运动 在 零 时 刻 开始 ， 稍 稍 
在 这 之 前 ， 关 节 力 矩 开 始 对 柔性 连接 预 变形 但 并 不 移 
动手 臂 末端 。 类 似 的 ， 当 手臂 末端 到 达 它 的 最 终 位 置 
时 ， 关 节 力 和 矩 必须 以 一 种 在 手臂 末端 (或 者 其 他 选 
定 输出 位 置 ) 不 可 见 的 方式 消除 手臂 变形 。 图 13. 14 
展示 了 来 自 Kwon [13.74]. 的 单 连 杆 手臂 的 例子 。 


Bi nto tas 
关节 角度 /rad 位 移 /in 
1.06 50 
0.85 40 
0.64 30 
B O 一 末端 点 位 置 | 
0.21 10 
0 0 
0.21 一 10 


| "0 02 04 06 08 1 12141618 2 22 


时 间 /s 
图 13.14 单 连 杆 柔性 臂 的 逆 动 力学 受 迫 运动 
5. 柔性 连 杆 反馈 控制 
连 杆 中 的 柔性 在 某 些 情况 下 使 用 与 集中 柔性 关节 
相同 的 方式 进行 控制 。 此 处 重点 讨论 的 是 特别 适用 于 
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连 杆 柔性 的 方法 ; 因此 利用 卡尔 曼 滤波 器 来 估计 顶端 
位 置 和 其 他 广泛 应 用 的 技术 都 不 再 进行 讨论 。 关 于 这 
个 课题 的 研究 已 经 有 很 长 的 一 段 历 史 了 。Cannon 和 
Schmitz U^ ?? | Truckenbrot! 751 和 其 他 人 表明 这 些 技 
术 适 用 于 柔性 连 杆 手臂 ， 并 且 系 统 的 非 并 列 特性 增强 
了 对 模型 误差 的 敏感 度 。 

应 变 测量 提供 了 和 柔性 连 杆 状态 的 一 个 有 价值 的 表 
达 ， 并 且 通 过 对 典型 嗜 杂 的 应 变 信和 号 进行 过 滤 分 化 得 
到 的 应 变 率 已 经 被 Hastings!3 ”| 展示， 成 为 一 个 克服 
纯 关 节 反 馈 控 制 带 来 的 制约 因素 的 有 效 方法 。 
Yuan! ® 下 提供 了 一 个 应 变 率 反馈 的 自 适应 版 本 。 

应 变 测量 很 容易 便 被 运用 到 模 态 幅 值 的 计算 当中 ， 
并 日 合理 放置 的 应 变 仪 测量 值 N 的 数量 等 同 于 待 分 析 的 
模 态 振幅 的 数量 。 在 这 种 情况 下 ， 估 计算 法 是 不 必要 
的 ， 尽 管 滤波 器 常常 会 被 用 到 。 如 果 一 个 杆 件 的 模 态 o; 
是 已 知 的 ， 应 变 就 与 w 的 二 次 导数 成 正比 ， 即 

9 小， 
oj = 

Ox j 

通过 对 系数 矩阵 进行 转 置 ， 很 容易 得 到 N 个 模 
态 的 振幅 。 如 果 深 扭转 在 模 态 的 变形 中 占据 了 很 大 一 
部 分 ， 我 们 需要 额外 注意 ， 但 是 原理 仍然 适用 。 高 频 
模 态 下 的 主动 控制 可 能 不 能 得 到 保证 ， 但 是 一 或 两 个 


(13. 83 ) 


最 低频 模 态 的 反馈 可 以 通过 传统 或 状态 空间 设计 技术 
以 增加 模 态 阻尼 来 实现 。 
ô, Qu Ay c Qy i E 
6 a Os c œ% 
fep c 01 T9 PE Cee”) 
by Qu Ano oe Q yy € N 


手臂 末端 位 置 测量 的 运用 永远 有 吸引 力 ， 且 对 于 
刚性 手 辟 消除 由 于 手臂 扭曲 和 时 变 的 手臂 校准 而 引起 
的 变化 性 十 分 有 效 。 机 器 视觉 能 够 消除 目标 位 置 以 及 
手臂 位 置 的 不 确定 性 。 然 而 ， 这 些 方法 受到 连 杆 柔性 
非 并 列 因而 非 最 小 相位 动力 学 的 困扰 ， 因 此 可 能 需 
特别 注意 。Wang'* ”提出 了 一 个 控制 方程 中 EOA 测 
量 的 替代 公式 ， 他 称 之 为 反映 的 尖端 位 置 。 对 于 一 个 
角度 9 和 长 度 1 的 转动 连 杆 ， 偏 转 位 置 是 19+6， 而 反 
映 的 尖端 位 置 10 -6 是 最 小 相位 。 这 个 关节 与 尖端 测 
量 的 组 合 产生 了 期 望 的 未 偏离 位 置 , 但 不 适用 于 
EOA 跟踪 控制 。Obergfell1 ”合成 了 一 个 了 基于 应 变 
反馈 的 输出 ， 结 合 了 同样 允许 轨迹 控制 的 EOA 位 置 。 
他 首先 用 从 连 杆 变形 的 光学 测量 中 获得 的 变形 反馈 建 
立 了 一 个 被 动 系统 ， 然 后 设计 了 一 个 尖端 位 置 的 传统 
反馈 控制 ， 该 位 置 通过 图 13. 15 所 示 的 两 个 大 连 杆 臂 
的 机 器 视觉 测量 获得 。 图 13. 16 与 13. 17 比较 了 一 个 


大 范围 内 的 一 个 平面 上 的 只 有 偏转 反馈 的 路 径 和 同时 
具有 偏转 及 EOA 位 置 反馈 的 路 径 。 


图 13.15 在 EOA 反馈 实验 中 使 用 的 大 型 灵活 机 械 臂 (RALF) 


端点 位 置 /m 
5.24 


5.22 


5.20 


5.18 


5.16 


514 1 于 1.82 180 1.78 1.76 


x 端点 位 置 /m 
图 13.16 无 EOA 位 置 反馈 时 的 路 径 
(命令 轨迹 的 一 部 分 由 浅 色 的 矩形 轨迹 表示 ， 
实际 轨迹 用 深 色 表 示 ) 
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3 端点 位 置 Im 端 传感器 而 言 。 滑 动 模式 控制 "中 与 被 动 控制 ** 
SER 为 解决 这 个 问题 提供 了 有 效 但 差别 极 大 的 方法 。 尽 管 
这 些 看 起 来 似乎 都 是 控制 的 更 有 前 景 的 方法 ， 我 们 还 
5.22 将 找到 更 多 解决 这 个 具有 挑战 性 的 控制 问题 的 方法 。 
及 控制 ， 自 适应 控制 ， 模 糊 控制 和 其 他 控制 方法 都 
a 不 同 程度 地 得 到 了 成 功 应 用 。 
5.18 
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感应 器 。 对 于 连 杆 惯性 参数 估计 ， 邻 近 基 座 的 连 杆 
动作 受 限 而 且 只 能 检测 力矩 ， 所 以 不 是 所 有 惯性 参 
数 都 可 以 确定 。 可 以 确定 的 是 影响 关节 力 抢 的 参 
数 ， 虽 然 它 们 可 能 会 出 现 复 杂 的 线性 组 合 。 


14.1 概述 


机 器 人 研究 中 有 许多 不 同类 型 的 模型 ， 为 了 对 
其 进行 精确 控制 ,我 们 需要 对 模型 进行 准确 识别 。 
前 面 章节 提 到 的 例子 包括 传感器 模型 、 执 行 器 模型 、 
运动 学 模型 、 动 态 模 型 和 柔性 模型 。 系 统 识别 是 关 
于 从 观测 识别 模型 的 过 程 的 领域 。 一 般 来 说 ， 有 两 
种 模型 : 参数 模型 和 非 参数 模型 。 参 数 模型 由 一 些 
参数 来 描述 ， 这 些 参 数 足够 描绘 模型 在 其 工作 范围 内 
的 精确 度 。 例 如 传感器 增益 和 偏 移 量 、 连 杆 的 DH 参 
数 和 刚体 惯性 参数 。 参 数 模型 特别 适合 机 器 人 ， 因 为 
机 器 人 的 组 成 部 分 是 人 造 的 ， 其 属性 是 可 控 和 可 
知 的 。 

非 参数 模型 包括 脉冲 响应 和 线性 系统 的 波 特 图 ， 
以 及 非 线性 系统 的 Wiener 和 Volterra ^" 。 非 参数 模 
型 可 作为 确定 一 个 参数 模型 的 基础 ， 例 如 ， 波 特 图 


(相位 和 幅度 对 应 输入 频率 的 图 形 ) 经 常 被 用 来 决定 
模型 的 阶 数 ， 如 一 个 执行 器 应 该 被 模拟 成 二 阶 还 是 三 
阶 系统 。 除 此 以 外 ， 当 系统 的 性 质 复杂 到 几 个 参数 的 
集合 不 能 描述 时 ， 也 需要 使 用 非 参数 模型 。 尤 其 在 生 
物 系统 中 就 是 这 种 情况 。 本 章 将 介绍 以 下 几 种 模型 的 
参数 标定 。 
1) 运动 学 参数 。 运 动 学 标定 是 指 对 象 之 间 基 于 
坐标 进行 定位 。 这 些 对 象 可 能 是 分 开 的 ， 也 可 能 是 通 
过 关节 连接 起 来 的 。 例 子 包 括 : 相对 于 全 球 坐 标定 位 
机 器 人 、 相 对 于 机 器 人 定位 它 的 立体 视觉 系统 、 相 对 
于 机 器 操作 手 的 抓 手 定位 被 抓 的 物体 和 定位 机 器 操作 
手 关节 的 邻近 坐标 系统 。 

2) 刚体 惯性 参数 。 这 个 参数 在 预测 移动 对 象 或 
机 器 操作 手 的 驱动 力 和 力矩 时 需要 。 

假设 有 NL ACD NS x 1 参数 向 量 由 = 
bi, ces Pra} o 这些 参数 可 能 线性 或 者 非 线性 的 
在 模型 中 出 现 。 
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线性 模型 参数 估计 的 修正 项 Ap 现在 可 以 通过 一 般 的 最 小 二 乘 
y =A'b (14.1) 法 来 获得 


非 线性 模型 1 


y 2f(x', d) (14.2) 
式 中 , y 2 |y, yul, FEM x1 的 输出 变量 ; x! 


Ao = (A'A) A" Ay (14.8) 
PEATE SR I p 29 + Ad, 


直到 Ad 变 得 足够 小 。Gauss- Newton 方法 是 二 次 收敛 


fay crt, xL] 是 输入 变量 。 对 于 线性 模型 ，4' 是 一 个 
MXN WIERE, CTR 4 是 输入 变量 x 的 函数 。 
任意 元 素 4; 可 能 是 一 个 关于 x 复杂 的 非 线性 函数 ， 但 
是 仅 用 一 个 数字 来 估计 。 对 于 非 线 性 模型 ， 输 入 变量 
出 现在 一 个 非 线 性 函数 里 f= 1f ues, ful, FS PERS 
方程 表示 。 隐 性 的 非 线 性 模型 f(y', x', p) =0 也 可 
能 在 标定 里 出 现 '*”; 它们 的 处 理 方式 与 显 性 的 非 线 
性 模型 类 似 (UL 14.2.2 节 )。 有 PP 个 不 同 的 观测 ， 
其 中 每 一 个 用 上 标 1=1,…, P 标 明 。 对 于 线性 模型 ， 
不 同 观 测 的 信息 通过 堆砌 P 个 方程 (14.1) 结合 
起 来 


y-Ao (14.3) 
XB, y= jy e, y | 是 一 个 MP x1 的 观测 向 量 ; 
4=14 ,4 是 MPx NN,, 维 的 。 这 些 参数 可 用 普 
通 的 最 小 二 乘法 估计 
p=(A'A) A"y (14.4) 
在 统计 学 里 ， 和 矩阵 4 被 称 为 回归 矩阵， 最 小 二 
乘 的 解决 被 称 为 回归 “1。 一 个 线性 模型 的 例子 是 刚 
体 模型 的 惯性 参数 。 
一 般 采用 Gauss - Newton 方法 '“* 引 估计 非 线 性 模 
型 (14.2)。 首 先 将 变量 x' (可 被 视 为 一 些 常数 ) 并 
入 非 线 性 方程 f'。 模 型 通过 次 迭代 当前 估计 o t 
行 泰 勒 展开 来 得 到 线性 化 
y. -f'(d +A) 
te gee, OF € 
“FG +P | ab 
=f'(p') +A'Ap 


+ 高 阶 项 


(14.5) 
SUP, yi 是 输出 变量 的 计算 值 ; A' = af'/ad 是 在 o 
估计 的 雅 可 比 矩 阵 。 忽 略 泰勒 级 数 的 高 阶 项 ,产生 了 
线性 化 的 形式 (14.5)。 我 们 现在 作出 一 个 大 胆 的 假 
设 ， 对 于 参数 估计 $y 的 修正 Ap 使 输出 变量 的 计算 
值 与 测量 值 相同 ， 即 ; yiyo EX Ay zy! - f (^) 
为 当前 模型 p! 下 测量 输出 和 预测 输出 之 间 的 误差 ， 
线性 化 的 方程 (14.5) ZER 
Ay! =A' Ap (14.6) 
然后 ,将 已 次 测量 的 线性 化 的 方程 堆砌 起 来 得 到 估 
计 形 式 


Ay =AAg (14.7) 


的 ， 在 给 定 一 个 好 的 初 值 ^ 并 且 非 线性 不 是 很 严重 
的 情况 下 收敛 速度 很 快 。 一 个 非 线 性 模型 的 例子 是 包 
E DH 参数 的 动力 学 模型 。 它 由 于 正弦 和 余弦 产生 的 
非 线性 是 轻微 的 ， 因 此 Gauss- Newton 方法 通常 能 很 
好 地 收敛 。 

然而 ,不 管 是 线性 还 是 非 线 性 估计 ， 不满 秩 和 数 
值 病态 的 情况 使 4'4 中 的 求 逆 出 现 问题 。 不 满 秩 可 
能 是 由 于 两 种 问题 : 

1) 数据 不 足 。 参 数 估计 需要 的 数据 数量 可 以 用 
可 观测 性 指标 来 量化 ,例如 回归 矩阵 4 的 条 件 
数 '*。 利 用 数据 选择 来 最 大 化 可 观测 性 指标 也 可 
能 获得 更 具 和 鲁 棱 性 的 估计 。 例 如 在 动力 学 标注 中 选 
择 不 同 的 位 置 ， 或 在 惯性 参数 估计 中 选择 不 同 的 
轨迹 。 
2) 无 法 辨识 的 参数 。 也 许 有 一 些 参数 没有 任何 
一 组 实验 数据 可 以 辨识 。 必 须 找 出 一 个 消去 或 者 避 开 
这 些 无 法 辨识 的 参数 的 方法 。 通 常用 奇异 值 分 解 
(SVD) 的 方法 来 消去 参数 ;而 避 开 这 些 参数 则 可 以 
使 用 先 验 值 或 者 岭 回 归 的 方法 。 这 不 是 意味 着 这 些 参 
数 本 质 上 是 不 可 辨识 的 ， 只 是 实验 设 定 导致 了 它们 的 
不 确定 。 例 如 ， 如 果 机 器 操作 手 的 基 座 是 固定 的 ， 它 
第 一 个 关节 的 十 个 惯性 参数 中 只 有 一 个 能 被 辨识 。 而 
另 一 种 实验 设 定 ， 一 个 加 速 的 基 座 加 上 测量 基 座 的 反 
作用 力 和 力矩 使 得 十 个 参数 中 的 其 他 参数 能 够 被 辩 
WTS, 

病态 可 能 由 于 测量 或 参数 的 不 当 缩 放 造成 。 

1) 最 小 二 乘 估计 最 小 化 输出 预测 值 和 测量 值 之 
间 的 误差 。 输 出 向 量 y 的 元 素 y; 可 能 有 不 同 的 单位 
和 幅度 ， 比 如 在 动力 学 标定 的 位 置 测量 中 的 弧度 和 
米 。 此 外 ,不 是 所 用 的 测量 都 有 同样 程度 的 精确 度 。 
选择 一 个 适当 的 加 权 和 矩阵 对 输出 向 量 归 一 化 可 以 得 到 
更 好 的 估计 。 

2) 各 个 参数 可 能 有 不 同 的 单位 和 幅度 。 这 可 能 
在 收敛 性 判别 和 决定 消去 哪个 参数 时 带 来 问题 。 表 
次 ， 对 参数 进行 加 权 也 可 以 改进 。 

这 些 数值 问题 对 任何 参数 估计 问题 是 通用 的 ， 
我 们 将 在 本 章 的 末尾 详细 讨论 。 下 一 节 将 分 别 讨论 
各 个 机 器 人 模型 和 如 何 将 它们 变 成 参数 估计 问题 的 
形式 。 
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14.2 ”运动 学 标定 

通常 ， 坐 标 系 里 的 相对 位 置 的 确定 需要 6 个 几何 
参数 (位 置 加 上 方向 ) 。 如 果 坐 标 系 里 的 相对 运动 有 
机 械 约 束 ， 如 关节 的 连接 ， 则 需要 的 参数 会 减少 。 对 
于 旋转 关节 连接 的 两 个 连 杆 ， 它 的 轴 是 一 个 行 约束 向 
量 ， 需 要 4 个 参数 。 对 于 移动 关节 ， 它 的 轴 是 一 个 自 
由 向 量 ， 只 需要 两 个 描述 方向 的 几何 参数 。 

此 外 ， 在 感应 器 和 机 械 偏转 的 建 模 力 还 需要 非 几 
何 参数 。 

1) 关节 角度 传感器 需要 确定 增益 和 偏 移 量 。 

2) 相机 标定 使 用 不 失真 针 孔 相机 模型 需要 确定 
焦 长 和 图 像 感应 偏 移 。 

3) 关节 齿轮 柔性 由 于 负载 和 机 器 操作 手 本 身 习 
力 引 起 的 角度 变化 。 

4) 由 于 机 器 人 在 工作 环境 里 非 刚 性 固定 造成 的 
基 座 柔性 。 其 造成 的 结果 是 ， 机 器 人 不 同 的 伸展 方式 
对 末端 位 置 产生 不 同 的 效果 。 

5) 在 精细 的 位 置 控制 中 ， 振 动 的 热效应 也 需要 
建 模 。 

本 节 的 重点 是 几何 参数 和 基于 感应 器 的 非 几何 参 
数 的 确定 。 


14.2.1 串联 机 器 人 


把 改进 Denavit- Hartenberg (DH) 参数 (WA 
14.1) 作为 一 个 主要 的 几何 参数 ( 见 1.4 节 )。 


u 


图 14.1 修正 DH 参数 


人 = Rot(x ,o,) Trans(x ,o;;) Trans( z,d;) Rot(z,0,) 

(14.9) 

1) 对 于 一 个 旋转 关节 为 i=1，…, nn 的 n 关 节 

HE, Ez 轴 是 空间 中 的 一 条 直线 ， 必 须 校 准 全 部 4 
MER a, di, o; 16. 


2) 对 于 一 个 移动 关节 ， 其 z, 轴 是 一 个 自由 矢量 ， 
只 需要 两 个 描述 方向 (a, 和 0) 的 参数 。 概 括 地 说 ， 
z; 轴 可 以 放 在 空间 中 的 任何 位 置 ， 这 意味 着 两 个 DH 
参数 是 任意 的 。 一 个 可 能 性 是 让 z 轴 与 0;,, 7 Be 
XL, 设置 d,,, =0 和 a,,, =0。 尽 管 运动 学 上 是 正确 的 ， 
但 是 这 样 的 设置 是 不 直观 的 ， 因 为 它 不 符合 棱柱 结构 
的 物理 位 置 。 可 以 根据 a; 2X 0, 的 值 设 定 a,,,, 使 z 的 
位 置 在 棱柱 关节 的 机 械 结构 的 中 央 。 

在 相 邻 的 轴 近 乎 平行 的 情况 下 ， 正 常态 定义 不 
清 ， 校 准 是 病态 的 。 在 这 种 情况 下 ，Hayatil ”1 引入 了 
关于 轴 7 ,的 一 个 额外 的 转动 参数 B，( 见 图 14.2) 。 


图 14. 2 ”对 近似 平行 的 轴 采 用 额外 的 关于 yi -1 的 参数 B; 


让 x/ 在 沿 着 O, 到 轴 z, ,的 直线 上 ， 这 样 使 得 
xf 1 垂直 于 =， 它 们 的 交点 定义 为 原点 Oio Fez, 
与 =z 关联 起 来 需要 两 个 旋转 量 : 对 于 x;_,， 旋 
转 o, YE zz | 映射 到 z,; MF y, =y 旋转 B;, 将 
Zi 映射 到 rm 现在 角度 0, 是 对 于 zx 从 es 到 X 的 
角度 。 这 样 ， 连 杆 变换 矩阵 为 

17! T, = Rot( y ,8,) Rot(x,a,) Trans( x ,a;) Rot(z,6, ) 
(14. 10) 


1) 对 于 转动 关节 ， 参 数 B, 取代 d;o 
2) 对 于 移动 关节 ， 关 节 变 量 d 要 保留 。 如 前 ， 
通过 确定 两 个 与 坐标 系 i+1 相关 的 坐标 将 > 放置 在 
连 杆 合适 的 位 置 。 然 后 对 d, =0 构造 Hayati 参数 。 随 
着 d, 的 改变 ， 轴 x, 依次 被 z 取代 相对 于 xz， (R 
写 出 ) 。 连 杆 变换 方程 变 为 
i-IT, = Rot( y ,B,) Rot(x,a,) Trans( x ,a;) 
Trans(z,d;) Rot(z,0,) (14. 11) 
尽管 这 个 变换 中 有 5 个 参数 ， 设 定 Hayati 参数 的 过 程 
相当 于 设 定 d, ,的 值 来 定位 0;_, ， 所 以 参数 的 数目 没 
有 净 增 。 
上 述 的 过 程 在 一 个 串联 机 器 人 中 设 定 了 中 间 的 连 
杆 为 坐标 系 。 基 座 和 端点 的 坐标 系 也 必须 设 定 ， 但 是 
这 一 过 程 由 外 部 度量 系统 和 端点 的 物理 约束 决定 。 最 
后 的 结构 可 能 是 nn 或 n+1， 而 第 一 个 结构 是 0 或 -1 
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(为 了 使 数目 连续 ) 。 例 子 如 下 所 示 。 将 未 知 动力 学 
参数 向 量 a,d, e, 0, MB 集中 到 参数 向 量 办 = la, 
d, a, 0, B} 中 。 参 数 四 预测 最 后 一 个 坐标 系 相 对 
于 第 一 个 的 位 置 和 方向 ， 如 "7, o 

不 是 所 有 6 个 位 置 相关 参数 都 必须 用 来 标定 ， 标 
定 所 需 参 数 由 1 到 6 不 等 。 标 定 通过 观察 某 个 参数 的 
预测 值 的 误差 ， 然 后 采用 非 线 性 标定 方法 (14.7). 
检查 误差 一 般 有 两 个 方法 : 

1) 开 环 标定 使 用 外 部 测量 方法 来 检测 位 置 参 
数 。 因 为 机 右 人 在 这 一 过 程 中 与 环境 无 关 ， 这 个 方法 
被 称 为 开 环 的 。 

2) 闭环 标定 使 用 端点 的 物理 约束 来 检测 。 物 理 
约束 的 偏差 值 代 表 了 预测 误差 。 因 为 与 物理 约束 有 
关 ， 机 器 操作 手 与 地 面 形成 了 闭环 。 

1. 开 环 运动 学 标定 

关于 标定 的 文献 里 有 很 多 种 度量 标准 系统 ， 它 们 
可 以 基于 测量 的 姿态 分 量 的 个 数 来 归 类 1。 

1) 1 个 分 量 : 到 末端 连 杆 任意 一 点 的 距离 可 以 
用 不 同方 法 来 测量 ， 如 球 棍 仪表 '*， 滑 线 电 位 
380^. gusce) EEUU, 

2) 两 个 分 量 : 使 用 单个 经 纬 仪 来 提供 两 个 方向 
的 测量 所 2 。 相 对 长 度 需要 缩放 。 

3) 3 个 分 量 ， 激光 跟踪 系统 通过 反射 末端 受 动 
器 上 安装 的 发 射 器 发 出 的 激光 射线 来 提供 准确 的 三 维 
测量 。 射 线 可 以 提供 长 度 信 息 ， 同 时 激光 舵 的 万 向 驱 
动能 提供 两 个 方向 的 测量 “中 。 由 于 这 种 设 定 最 不 
准确 的 部 分 是 角度 感应 ， 另 一 种 方法 采用 三 个 激光 跟 
踪 系 统 仅 使 用 长 度 信息 。 商 业 化 的 3-D 立体 相机 运 
动 跟踪 系统 也 提供 位 置 的 高 精度 的 测量 。 

4) 5 个 分 量 : Lau et al.'“ 中 提出 了 带 有 可 转向 
反射 器 的 可 转向 激光 干涉 仪 。 通 过 测量 俯仰 和 偏 航 ， 
可 转向 激光 干涉 仪 产生 了 位 置 的 三 个 参数 ， 同 时 可 转 
向 的 反射 器 产生 方向 的 两 个 参数 。 

5) 6 个 分 量 : 完整 的 姿态 可 以 通过 末端 连 杆 上 多 
个 点 的 3-D 位 置 推 新 ， 可 用 立体 相机 系统 来 测量 。 与 
这 些 点 对 应 的 坐标 系 可 以 产生 位 置 和 方向 分 量 *"。 
Vincze et al. (^ "用 单 光线 激光 跟踪 系统 测 量 完整 的 次 
态 ， 通 过 给 机 器 人 装配 安装 在 万 向 关节 的 回 反射 器 上 。 
仍然 用 干涉 测量 法 测量 位 置 。 新 颖 的 地 方 在 于 其 方向 
是 用 回 反射 器 边缘 的 不 同 成 像 模式 来 测量 的 。 

我 们 给 出 测量 三 个 姿态 分 量 和 所 有 6 个 姿态 分 量 
的 例子 。 

(1) 点 式 测量 终端 连 杆 上 某 个 点 的 3-D 位 置 
可 以 通过 立体 相机 系统 方便 的 定位 。 Tm ue 
一 个 全 局 坐标 系 ， 机 器 人 的 第 一 个 参照 系 相 对 它 


huj 
qu! 


位 。 为 了 提供 足够 的 参数 ， 需 要 引入 一 个 中 间 坐 标 
A; 这 个 中 间 坐 标 系 序号 是 0， 而 相机 系统 的 序号 是 
-1， 这 样 能 保持 数字 的 连续 。8 个 参数 中 的 两 个 是 
任意 的 。 图 14. 3 展示 了 一 种 可 能 的 情况 : z 与 z_, 平 
ff (a, =0) HES (a。=0)。 和 较 准 参数 是 d, ，0,， 
a, d, o, MO o Ez 与 < 接近 平行 的 情况 下 ， 测 
量 坐 标 系 可 以 简单 的 重新 定义 来 避免 使 月 
数 ; 例如 ， 可 以 把 y | 重新 定义 成 z_|。 


d Hayati 参 


22 


图 14.3 相机 系统 (序号 -1 ) 相对 于 机 器 人 的 
坐标 系 1 通过 一 个 中 间 坐 标 系 0 放置 


在 终端 连 杆 ， 原 点 0, 和 轴 x, 是 不 确定 的 ， 所 以 
相关 的 参数 d, 和 0, 也 不 确定 。 定 位 测量 点 仅 需要 三 
个 参数 ， 所 以 为 了 提供 一 个 额外 的 参数 ， 需 要 一 个 额 
外 的 坐标 系 n +1。 测量 点 定义 为 新 坐标 系 的 原点 
0, ,1 ， 而 用 z, 的 法 线 与 0, ,交叉 可 定义 轴 x，( 见 图 
14.4) 。 三 个 参数 是 任意 的 ; 一 个 简单 的 选择 是 使 z,,， 
5z, (a, 20) Fit, Hx,,, 5x, HA (6,,, =0 和 
d, ,1 20). (EBACE a,,,, d, 和 0,。 


Xn+1 Zn-l 


图 14.4 已 测 点 0, ,1 通过 增加 坐标 系 n+1 定位 在 末端 


通过 变换 T= TT, 测量 点 的 位 
Ep, a 相对 相机 的 坐标 被 提取 出 来 。 将 各 个 未 知 运 
动 学 参数 集合 成 向 量 g，d，aw，6 和 有 ， 合 并 成 参数 
向 量 $=|a, 4，a，0, B1。 非 线性 运动 学 模型 与 式 
(14.2) 类 似 

"pia 2f(4 d) ,=1,.…,P 


(14. 12) 
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AF, a 是 姿态 ! 关节 变量 向 量 。 为 了 把 这 个 方程 线 
性 化 成 式 (14.6) 的 形式 ， 计 算出 相关 的 雅 可 比方 
程 为 


A" pam Di Pha = J AP 

Aa 

Ad 

= (Qf, J, IJ, Jg) | Aa 

A0 

AB 
式 中 ， 每 个 参数 的 雅 可 比 和 矩阵 一 个 典型 的 列 了 是 从 螺 
杆 参 数 得 到 的 ， 就 像 其 他 每 一 个 参数 代表 了 一 个 主动 

关节 ( 见 1.8.1 节 )。 


(14. 13) 


E DH 
Is (14.14) 
' xg Hayati 
Is z (14. 15) 
1 "rag x kK c 
du s (14.16) 
i Xa X dianas Hayati 
Jy = ux di (14. 17) 
J; = "VA x EC (14. 18) 
seid! = Rp, EBA -1 的 原点 。 将 所 


有 姿态 下 的 方程 (14.13) 排列 起 来 得 到 最 终 的 估计 


Ap, =JAb (14. 19) 
它 对 应 式 (14.7) ， 并 由 最 小 二 乘 求 解 Ad, WHI 


代 求 解 po 

(2) 全 位 姿 测 量 ”假设 测量 了 连 杆 n 中 的 坐标 
nel ( 见 图 14.5)。 坐 标 系 n 通常 是 完整 的 ，6 个 
来 定位 坐标 系 n+1 的 已 标定 的 参数 是 d,, a,, 0,, 
Onis daa O, ao WR za ILE z, 平行 的 ， 这 
个 轴 可 以 简单 的 变换 到 其 他 的 轴 ， 如 y,,, ， 来 避免 使 
用 Hayati 参数。 


Zn+1 


Wa VL os On+1 
= V 
dii 
Xp o Un 
—» 连 杆 n-1] AZn 
关节 n-1 Ont 


图 14.5 末端 连 杆 坐 标 系 n+1 的 全 位 姿 测 量 


除了 位 置 方程 (14.12) 以 外 ， 坐 标 系 n+1 的 
方向 方程 


TR a =F(q',@) ,=1,.…,P (14.20) 
Wi T, ,提取 ， 其 中 五 是 一 个 和 矩阵。 将 这 个 方程 线性 
化 可 以 得 到 


A" RA = URS x "RA, 
=4A7'p! X UR. 
S(A "p, CRAT Ri) Rs) 
(14. 21) 
RP, Ap, ÆRTER, EAE XT fA WUE 
向 量 的 有 限 差 分 。 继 续 这 样 的 推导 ， 与 之 前 空间 速度 
( 见 1.8 节 ) 的 雅 可 比 和 矩阵 类 似 ， 雅 可 比 和 矩阵 用 来 表 
示 参 数 变化 Ap 对 于 位 置 A p; 和 方向 Ap 的 


混合 效果 : 
人 E 'p, +1 
=J'A 
» "p.a ý 
与 式 (14.13) 相 比 ， 雅 可 比 和 矩阵 了 现在 有 6 行 , 每 
个 参数 的 Jacobians 是 : 


xi 
| ) om 
0 


(14.22) 


Jf 3r (14.23) 
Xia 7 
Hayati 
( 0 ) 
-igi 
Zi 
sal ; (14. 24) 
"aa x "di, +1 
PE DH 
l Xi 
Ja = (14. 25) 
Oa x "dia +1 
v Hayati 
X i 
1 E SE us 
Js = PE (14. 26) 
Zi 
eod -1 yl 
Jiz x d;. nc 
| MD | (14. 27) 
Jii 


跟 上 面 一 样 ，A% 用 最 小 二 乘法 获得 , 内 通过 和 迭代 
求 得 。 

2. 闭环 检测 

末端 执行 器 位 置 和 方向 的 物理 约束 可 以 代替 讽 
量 。 物 理 约束 的 位 置 定义 了 参照 坐标 系 ; 末端 位 置 或 
方向 的 测量 因此 可 以 定义 为 零 。 由 于 错误 运动 学 模型 
引起 的 物理 约束 的 偏差 表现 为 参照 坐标 系 上 的 移 位 。 
类 似 于 点 式 测量 和 全 位 姿 测量 ， 闭 环 方法 也 有 点 约束 
和 全 位 姿 约束 。 

d) 点 约束 ”假设 末端 执行 器 有 一 个 尖 头 与 环境 
中 的 一 个 固定 的 点 接触 。 尖 头 的 方向 能 通过 改变 关节 
的 角度 来 改变 ， 只 要 接触 点 不 改变 。 前 文中 ， 点 式 测 


pea 


中 | 
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量 的 测量 系统 定义 了 参照 坐标 系 -1 (DLE 14.3), AR 


端 执行 右 坐 标 系 n+1 原点 0, ,已 测 知 ( 见 图 14.4)。 
现在 参照 坐标 系 的 原点 0, 标记 为 0 且 与 0, ,重合 
( 见 图 14.6) 。 因 为 一 个 点 相对 于 坐标 系 1 定位 仅 需 三 
个 参数 : a, d,, ， 和 0 ， 所 以 不 需要 额外 的 坐标 系 
1。 任 意 选择 a 


0， 就 是 说 ，zu Sz, 平行 。 


图 14.6 固定 点 接触 (EE 00=0,,1 ) 


不 同 的 可 以 维持 点 接触 的 姿态 可 以 手动 产生 ， 或 者 使 
用 动力 控制 自动 产生 。 与 式 (14.13) 相 比 ,测量 的 
MEEK pia =0， 线 性 化 的 标定 方程 可 以 简单 的 
写成 : 


Ap. =- pua =J Ap (14.28) 
可 产生 的 姿态 总 数 由 于 开 环 标定 影响 可 辨识 性 而 受 限 。 

(2) 全 位 姿 约束 ”与 全 位 姿 测量 (JILE 14.5) 
类 似 ， 末端 连 杆 可 能 完全 受 限 与 环境 紧密 贴 合 。 如 果 
机 器 人 是 元 余 的 (58 01 章 ) ， 姿 态 能 通过 本 身 的 动 
作 产 生 。 产 生 这 样 的 姿态 要 求 完 成 末端 力 /力矩 传 感 
或 者 关节 力矩 传 感 。 

由 于 跟 地 面 严密 的 接触 ， 末 端 连 杆 可 以 被 视 为 地 
面 的 一 部 分 ， 因 此 该 系统 比 点 固定 的 情况 需要 更 少 的 
坐标 系 。 图 14.7 显示 了 一 个 设置 坐标 系 的 方法 ， 设 
定 了 坐标 系 0 和 no Hz, Siz, 相等 且 重 合 。z。 和 
zi 的 相同 标准 设 定 了 原点 0, 和 轴 xz。 坐标 系 半 通过 
定义 0, = 0, fll x, 2x, 完成 。 为 了 标定 产生 了 6 个 参 
数 结果 ， 它 们 必须 联系 坐标 系 和 坐标 系 0: 0,, d,, 
a,, a, di, MOO 

与 式 (14.28) 类 似 ， 在 序号 调整 之 后 ， 定 义 已 
测量 的 位 置 "z =0， 则 线性 化 的 位 置 标定 方程 为 

A°p = -"pl, (14. 29) 
注意 到 方向 的 误差 式 (14. 21) ， 已 测量 的 方向 "R' =I 
单位 矩阵， 在 序号 调整 之 后 。 

S(A’p),) =(T- RD)( RD) = CR, -I 

(14. 30) 
然后 像 在 全 位 姿 测量 中 一 样 应 用 误差 方程 (14.22), 


2^ Xna AE «ei 
2 — — 
Oi 


£n — £0 | 4 
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dn\! 
1 
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Pas 777 On 


图 14.7 全 约束 的 末端 连 杆 〈 设 定 0o -0,) 


在 序号 调整 之 后 。 可 产生 的 姿态 总 数 由 于 开 环 标定 影 
响 可 辨识 性 而 受 限 。 


14.2.2 并 联机 器 操作 手 标定 


并 联机 器 操作 手 由 多 个 闭环 组 成 ， 前 面 一 节 所 述 
方法 可 以 直接 扩展 到 标定 并 联机 器 人 。 比 起 对 并 联合 
串联 机 器 人 用 不 同 的 方法 ， 对 不 同 的 情况 和 不 同 环节 
安排 的 标定 方程 重新 进行 复杂 的 推导 ，Hollerbach 和 
Wampler“ 引 提出 了 一 种 统一 的 方法 叫做 标定 指数 ， 
它 把 所 有 的 标定 问题 视 为 闭环 标定 问题 。 通 过 把 末端 
执行 器 测量 视 为 一 个 关节 ， 可 以 把 开 环 标定 包括 在 闭 
环 标 定之 内 。 所 有 的 测量 ， 从 关节 到 测量 系统 ， 都 使 
用 同样 的 脚 标 ， 都 看 作 没有 检测 的 关节 ， 包 括 没 有 检 
测 的 姿态 成 分 、 被 动 的 环境 约束 ， 或 者 链 中 没有 传 感 
器 的 关节 。 在 平行 连 杆 机 构 中 ， 列 出 足够 数量 的 闭环 
方程 来 描绘 运动 学 性 质 ， 并 且 在 每 个 姿态 合并 起 来 。 
因为 闭环 方程 是 所 有 测量 的 隐 函 数 ，umpler 7 
把 这 种 标定 方法 叫做 隐 含 环 路 方法 。 

图 14. 8 阐明 了 这 个 方法 应 用 在 一 个 立体 相机 测 
量 系统 中 测量 一 个 未 标定 的 机 器 人 的 末端 执行 器 上 的 
一 个 3-D 坐标 。 右 边 是 相机 系统 用 棱柱 支架 代替 ， 
代表 一 个 六 自由 度 的 关节 ， 提 供 了 等 效 3-D 坐标 测 
量 。 结 果 是 一 个 闭环 机 构 。 第 ;=1,…，P) TX 
态 的 运动 学 闭环 方程 为: 

f (0) =f p) =0 (14. 31) 
AP, p 是 需要 标定 的 机 器 人 参数 的 向 量 ， x 是 关节 
传感器 结果 的 向 量 ; "包含 了 传感器 读数 x' 所 以 被 给 
定 一 个 序号 ; 联合 P 个 位 姿 的 式 (14.31) 写成 一 个 
和 矩阵 形式 


二 


f(b) 2 QU f£) =0 (14. 32) 
围绕 参数 标 称 值 线 性 化 (14. 32) 
Af= S Aged (14.33) 


ap 
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式 中 ，Af 是 计算 的 闭环 方程 的 对 零 的 偏差 ，A 是 单位 
雅 可 比 和 矩阵 ，Ag 是 要 用 于 当前 参数 估计 的 修正 值 。 
标定 问题 可 通过 使 用 迭代 最 小 二 乘 来 最 小 化 Af 求解 。 


图 14.8 外 部 测量 系统 用 六 自由 度 的 关节 模拟 


1. 标定 指数 
运动 学 标定 的 基础 是 计算 使 用 运动 学 模型 定位 一 
个 机 器 操作 手 的 误差 。 此 误差 可 能 与 外 部 计量 系统 的 
测量 有 关 ( 开 环 方法 ), 或 者 与 物理 约束 (如 与 平面 
接触 ) 有 关 (闭环 方法 )。 外 部 计量 系统 可 以 测量 位 
姿 的 所 有 6 个 分 量 或 者 其 中 几 个 ， 如 末端 的 一 个 点 (3 
个 分 量 )。 同 样 ， 物 理 约束 可 以 限制 位 姿 的 1~6 个 分 
量 。 约 束 和 测量 可 能 混合 出 现 。 约 束 和 测量 的 数目 决 
定 了 每 个 位 姿 可 获得 多 少 可 用 来 标定 的 标量 方程 。 
标定 参数 C 确定 了 每 个 位 姿 的 方程 个 数 。 这 种 
分 析 对 串 行 联动 是 很 直接 的 ， 但 是 对 平行 联动 来 说 推 
出 每 个 位 姿 的 方程 个 数 比较 困难 。 
C-S-M (14. 34) 
式 中 ,5 是 传感器 指数 ; M 是 活动 性 指数 。 活 动 性 指 
JUST XR Tn ce Bee “PAY BB, 
M = 6n - Ya 
SUP, n 是 连 杆 的 个 数 ; NN) 是 关节 的 个 数 ; n 是 关 
节 的 约束 的 个 数 。7 包括 了 任意 额外 连接 到 机 器 人 
的 连 杆 ， 限 制 或 者 测量 它 的 运动 。N, 包括 任何 为 了 
标定 附加 联动 的 关节 。 对 于 转动 或 者 棱柱 关节 ， 立 = 
5; 然而 对 于 球状 关节 , ni =3。 对 一 个 测量 自由 移动 
的 末端 执行 器 的 外 部 测量 系统 ww =0， 末 端的 刚性 附 
(Eni =6。 一 般 而 言 式 (14.35) 是 准确 的 ， 但 是 也 
有 一 些 例外 ， 特 殊 或 者 退化 机 制 引起 的 必须 具体 分 析 
的 个 例 ( 见 第 12 章 ) 。 
传感器 指数 $ 是 关节 上 所 有 传感器 的 个 数 


lm 


(14. 35) 


(14. 36) 


SUP, S, 是 关节 i 上 感 测 的 自由 度 个 数 。 通 常 驱动 关 
节 的 5;=1， 而 全 位 姿 测量 的 末 段 关节 WN) 的 Sy, =6。 


对 于 没有 感 测 的 关节 ， 如 被 动 环境 运动 ，$; =0。 

如 果 P 是 位 姿 的 个 数 ，CP 就 是 标定 过 程 中 的 方程 
总 数 。 很 清楚 地 ， 较 大 的 C 意味 着 需要 较 少 的 位 姿 ， 其 
他 的 不 变 。 对 于 单 链 的 情况 ， 包 含 了 一 系列 感知 的 低 阶 
机 器 关节 (S,=1, nf =5, i21, =, N,-1) 和 连接 末 
端 执 行 器 到 地 面 的 末端 关节 (Sy, ny). HX 14. 34 和 
式 14.35 可 得 到 


CzSy tny (14. 37) 

根据 标定 指数 ， 使 用 末端 全 约束 与 全 位 姿 测量 是 
等 效 的 运动 标定 。 有 一 个 潜在 的 问题 是 末端 约束 系统 
可 用 的 位 姿 范围 比较 小 ， 除 此 ， 两 者 的 机 制 是 一 样 的 。 

2. 串联 标定 方法 的 分 类 

基于 不 同 的 位 姿 测量 或 末端 约束 有 很 多 种 标定 方 
法 。 这 些 方 法 根据 标定 指数 C、n%j 和 5%j 的 值 分 类 
如 下 : 

1) C26, ny =0, Sy, =6 对 应 全 位 姿 测量 。n% = 
6，Sw =O 对 应 末端 附件 严格 固定 的 情况 ， 即 全 约束 。 

2) C=5。 ny, 20, Sy, =5 对 应 5 个 自由 度 的 位 
Bie nj =5, Sy, =0 对 应 5 个 自由 度 的 末端 
AR, RIBERA ESI BEET Do ALII 。 

3) C24, XT C=4 的 情况 尚 无 发 表 的 方法 。 

4) C23, ny, =0，Sw =3 对 应 3 个 自由 度 的 位 
ZW. ny, =3, Sy =0 对 应 3 个 自由 度 的 末端 
AR, 

5) C=2, n 20, Sy, 2 2 对 应 两 个 自由 度 的 位 

姿 测量 ， 如 单个 经 纬 仪 [14. 12]。m =2，Sw =0 对 
应 两 个 自由 度 的 末端 约束 。 治 着 直线 的 运动 提供 了 两 
^- Er BER ZA REUS 。 
) C=1, nj 21, Sy =0 对 应 仅 有 一 个 自由 度 
的 测量 ,线性 换 能 器 如 线性 差 动 变压器 (LVDT) ^? 
sd B Be UT, n = 1，Sw = 0 对 应 平面 
ptm, 

3. 并 联 标定 方法 的 分 类 

要 标定 并 联机 器 人 ， 需 要 给 每 个 环 路 7 写 一 个 闭 
环 方程 : 


CN 


0=f.(9) (14. 38) 

将 所 有 环 路 的 方程 合并 。 问 题 是 要 消去 未 感 测 的 
自由 度 。 基 于 环 路 的 个 数 应 用 标定 指数 的 方法 。 

1) 两 个 环 路 。 两 个 环 路 的 机 制 包 含 三 个 臂 或 

轴 ， 连 接 到 一 个 公共 的 平台 上 。 例 如 RSI Research 

Ld. 的 手动 控制 器 一 21 ， 应 用 了 三 个 六 自由 度 的 臂 ， 

每 个 臂 有 三 个 感 测 的 关节 。 这 种 机 制 的 活动 性 是 M = 
6。 由 于 S=9， 所 以 C=3， 闭环 检测 是 可 能 的 。 

2) 4 个 环 路 。Nahwi 等 .标定 了 一 个 球形 肩 
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关节 ， 由 四 个 柱 形 轴 宛 余地 驱动 ( 见 图 14.9). 


图 14.9 宛 余 的 平行 驱动 肩 关 节 


此 外 ,平台 约束 为 绕 球 转动 。 对 应 4 条 轴 ， 形 成 
了 4 个 运动 环 路 。 对 于 这 个 系统 ，M =3，S=4， 所 
以 C=1。 因 此 自 标定 是 可 以 的 。 如 果 没 有 额外 的 那 
条 腿 和 它 所 提供 的 传 感 ，C =0 则 不 能 进行 标定 。 

3) 5K, Wampler Ais S21 A FA Pa Ry DER AE. 
了 六 轴 运 动 平 台 (M=6)。 除 了 轴 的 长 度 ， 一 个 轴 的 
所 有 角度 也 测量 了 (S = 11)。 增 加 额外 传 感 是 为 了 
产生 一 个 唯一 的 正 向 运动 解 。 然 而 另 一 个 好 处 是 ， 由 
于 C=5， 可 以 进行 闭环 标定 。 对 于 一 个 没有 安装 传 
感 器 的 普通 的 六 轴 运 动 平 台 ，$=6， 所 以 C=0， 需 
要 外 部 位 姿 测量 。 例 如 ,通过 全 位 姿 测量 5 = 12， 
C =6。 参 考 文 献 [14.23] 中 使 用 了 全 位 姿 测量 


o 


14.3 ”惯性 参数 估计 
一 个 刚体 i 有 10 个 惯性 参数 : 质量 m,、 相 对 于 
原点 Oo 的 质心 zo, 和 相对 于 原点 O, 的 对 称 惯性 矩阵 
( 见 图 14. 10) 。 刚 体 可 以 是 未 端 执行 器 的 负载 ， 或 者 
机 器 人 自身 的 一 个 连 杆 。 通 过 产生 一 个 轨迹 以 及 测量 
力 或 者 力矩 并 结合 速度 和 加 速度 ， 一 部 分 或 者 所 有 的 
惯性 参数 可 以 估计 出 来 。 
连 本 1 
fi Cn) Om 


hia 


图 14. 10 一 个 中 间 连 杆 ; 重心 的 
位 置 和 力 / 力 矩 约束 


14.3.1 负载 惯性 参数 估计 


从 负载 惯性 参数 估计 开始 ， 为 连 杆 惯性 参数 估计 


设 定 了 平台 


。 假 设 有 一 个 腕 安装 的 六 轴 力 /力矩 传 感 


Lr RHET Ar tb RO HR Aer c 


REO, 和 加 速度 0 。 
参数 估计 的 过 程 包括 : 


1) 构造 负载 动态 的 Newton- Euler 方程 来 揭示 与 


惯性 参数 的 线性 相关 ， 


使 用 一 般 的 最 小 二 


.负载 动态 


乘法 估计 参数 。 


Sind 力矩 传 感 絮 是 末端 连 杆 nn 的 一 部 份 ， 
安装 在 关节 轴 z, 和 原点 O, 附近 。 传 感 器 提供 了 相对 


FABER A n+ 


1 的 读数 ( 见 图 14.11), 
的 其 他 部 分 附 在 力矩 传感器 的 柄 上 ， 所 以 力 抢 传感器 
测量 未 端 连 杆 的 负载 ， 但 是 不 包括 连 杆 本 身 。 力 和 失传 
感 器 参照 系 的 加 速度 必须 基于 对 原点 0, 的 


末端 连 杆 


DEAS 


计算 ， 但 是 我 们 忽略 复杂 性 而 假设 传感器 的 原点 


Orsi 与 点 O, 重合 。 


连 杆 n 


Gi 质心 ) 


&( 重 力 ) 


图 14.11 末端 连 杆 的 动态 特性 


连 杆 n 的 质心 定义 为 C,， 相 对 于 基 座 原点 O, E 
位 为 r, =C, -0,， 以 及 相对 于 连 杆 于 的 原点 O, 定位 


ÄH e, =C,- 0,0 
坐标 系 n 


所 有 向 量 和 和 矩 阵 在 坐标 系 n 中 表达 。 
相对 原点 O, 的 质心 位 置 ce, ,和 惯性 矩阵 工 


是 常数 。 力 矩 传感器 测量 传感器 坐标 系 原 点 0, 处 空 


间 的 力 f,， 但 是 


读数 假定 为 变换 到 连 杆 n 坐标 系 。 


从 第 2 章 式 (2.33) 可 得 ,关于 0, 的 Newton- 


Euler 方程 为 


f=La, +, XIV, 
性 元 ， 空 间 加 速 
则 右边 的 第 


m,S(e,) Y e, 
mi Ay, 


cp NAM 


将 空间 避 
入 式 (14.39), 
I, 
m,S(c, a 


fUv, = dy, -0,X7,, 


(14. 39) 
度 a, 和 空间 速度 w 代 
一 项 变 为 : 


nd - 
m,S(c,) c, *m,( do, - €, xv,) 


右边 第 二 项 变 为 ; 
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S(w,) S) 
0 RA 


I, eee 
m,S(c,) T m, 1 v, 


S(«,)1,c, * m,S(c,)S(«,)v, 
S(e,) m,S(c,) c, +S(@,)m, v, 


合并 ， 并 简化 得 到 


Va XI,v, = 


f | 1,0, + S(,) 1,0, - S( dy, )m,¢, | 


m, dy, + S(«, ) m,c, + S(&, )S(e, ) m,c, 


(14. 40) 
AP, MEHE m,e, 作为 合并 中 需要 估计 的 数量 出 现 。 


然而 ， 因 为 质量 m, 是 分 别 地 从 md 这 项 估计 的 ， 质 
e, 可 以 提取 出 来 。 明 确 考 虑 重力 8g， 我 们 随后 将 


d,-g 代入 dus 

为 了 制定 估计 算法 ， 通 过 腕 式 传感器 测量 的 力 和 
力矩 必需 在 几何 参数 和 未 知 的 惯性 参数 的 乘积 里 表 
达 。 根 据 以 下 符号 ， 惯 性 矩阵 的 元 素 矢 量化 为 KZ ) : 


Li 

w 0, œ 0 0 0 i 

Iw =| 0 o 0 œ w 0 hs 
0 0 e, 0 o, c, Ia 

I, 

Ia 

=L(w, )I(L,) 
其 中 , L (@,) 是 3 x6 的 角速度 矩阵 ， 


I "m li 
I, = "m Ly D, 
I; L 


23 I 


用 这 些 表达 式 ， 式 (14.40) 可 以 写 为 


ie 
0 -S(d,) L(o,) *S(o,)L(o,) 
d, S(o,) *S(v,)S(o,) 0 
m, 
X| M,C, 
KL) 
或 更 简洁 地 


f, -A,0, (14. 41) 
xh, A, 是 一 个 6 x 10 的 矩阵 ; e, 是 10 个 线性 出 现 
的 未 知 惯 性 参数 的 向 量 。 


2. 参数 估计 

AEM A, 里 的 元 素 直 接 通过 从 测量 到 的 关节 和 朋 
度 、 估 计 的 关节 速度 和 加 速度 进行 运动 学 计算 得 到 。 
关节 速度 和 加 速度 的 估计 值 通过 关节 角度 数据 进行 带 
通 滤波 得 到 “” 。 向 量 凡 的 元 素 直接 用 腕 式 力 传 感 
器 测量 得 到 。 为 了 在 有 噪声 的 情况 下 进行 稳定 的 佑 
计 ， 大 量 的 数据 点 通过 沿 着 适当 的 轨迹 移动 机 器 操作 
FAG. HA HR S, MA, 为 


A, f 
ZH ZH (14.42) 
A; A 


式 中 , P 是 数据 的 数目 。 
由 的 最 小 二 乘 估 计 为 

由 =(474) "A'f (14. 43) 
式 (14.43) 也 可 以 以 递归 的 形式 表达 并 进行 在 线 估 
计 。 为 了 识别 物体 ， 得 到 关于 质心 的 惯性 是 很 理想 
的 ， 这 可 以 通过 平行 移 轴 定理 实现 。 特 征 值 分 析 可 以 
把 惯性 矩阵 对 角 化 来 揭示 主要 的 轴 和 惯性 。 


连 杆 惯性 参数 估计 


通过 把 每 个 连 杆 i 作为 负载 对 待 ， 前 面 的 公式 可 
以 延伸 到 连 杆 惯性 参数 估计 问题 。 不 像 负 载 估计 ， 唯 
一 的 传 感 是 关节 转 矩 。 缺 少 全 部 的 力 / 力 和 矩 感应 ， 且 
基 座 附近 的 运动 受 限 ， 使 得 找到 所 有 的 近 端 连 杆 的 惯 
性 参数 变 得 不 可 能 。 缺 少 的 参数 不 重要 ， 因 为 它们 没 
有 控制 机 咒 手 臂 的 效果 。 

对 于 用 齿轮 连接 的 电力 驱动 ， 关 节 力 和 矩 可 以 由 关 
节 力 矩 传 感 器 测量 (IL 19.2.4 15), 或 用 电动 机 模 
型 ( 见 6.3 节 ) 从 电动 机 的 电流 估计 。 大 多 数 机 器 
人 没有 关节 转 矩 传感器 ， 这 种 情况 下 需要 关节 摩 探 。 
关节 摩擦 消 耗 了 电动 机 产生 的 大 部 分 的 转 矩 。 库 仑 和 
茜 性 摩擦 是 摩擦 模型 中 最 重要 的 组 成 部 分 ， 尽 管 在 关 
节 低 转速 下 Stribeck 摩擦 也 必须 建 模 :61 。 
摩擦 模型 通过 一 次 移动 一 个 关节 和 关联 电动 机 转 
和 矩 和 转速 来 估计 。 由 于 电动 机 磁场 的 未 补偿 和 不 均 
5]U^7281. s h TAHE HL s BS [rH REGE LE, 
ZU UR Pep HT fe rs EB 

HETA n 个 关节 的 机 器 操作 手 〈 见 图 
14.10) (只 有 上 有 具有 转动 关节 的 机 器 操作 手 被 考虑 ， 
因为 柱状 关节 的 处 理 仅 需要 对 算法 进行 细微 的 修 
改 。)。 定 义 ff 为 仅 移动 连 杆 j 对 关节 ii 产生 的 空间 力 。 
FÆ, f; 是 移动 关节 i 所 在 连 杆 对 关节 产生 的 空间 力 ， 
与 式 (14.41) 相同 ， 只 是 在 和 矩阵 4, PH i Rèn 
f, -'A;d, (14. 44) 


14. 3. 2 


N 
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RP, d, 是 未 知 的 连 杆 i 的 惯性 参数 向 量 。 增 加 上 标 
i 表示 向 量 在 连 杆 i 的 坐标 系 里 表示 ， 所 以 质心 xc, 和 
惯性 矩阵 元 是 常数 。 

关节 ;全 部 的 空间 力学 是 到 关节 的 所 有 远 端 连 杆 
的 空间 力 六 的 总 和 


T = 2 f 
关节 的 每 个 空间 力 'fj 通 过 转 递 跨 越 中 间 关节 远 端 的 
空间 力 矿 确定 。 使 用 空间 力 变换 矩阵 ' 
fa =K aaa =X A Pia 
(14. 46) 
KTHE, PAVERS! = Lua. NT IRS J 
连 杆 运动 产生 的 第 i 个 关节 的 力 和 力矩 ， 这些 和 矩阵 可 
以 连 乘 : 
f = Xia Xian MT, = ‘XA, (14. 47) 
fh eH 32 Bh HEY E = fa E EK k TT DL RÈ 
(14.45) 和 式 (14.47) 导出 


(14. 45) 


fo, (XNA, XPA, = XUAN (Q, 

fy EI 0 "XT A, "XTA, 内 

f 0 0 "XA, A, 
(14.48) 


方程 的 未 知 参数 是 线性 的 ， 但 是 左边 由 每 个 关节 的 全 
部 力 - 力 矩 向 量 组 成 。 因 为 通常 只 有 关节 旋转 轴 z; 的 
TB T; 可 以 测量 ,每 个 空间 力 'f; 必须 投影 到 关节 旋 
转轴 ，(14.48) 简化 为 


T=Koh (14. 49) 
其 中 
A . 内 
«(er ge ata, ó-|: 
$, 


WIE, 若 i>j，K; =01xw 对 一 个 n 连 杆 的 机 器 操作 
F, T 是 一 个 nx1 的 向 量 , p 是 一 个 10n x1 的 向 量 ， 
K 是 一 个 n x10n 的 矩阵。 

式 (14.49) 表示 了 机 器 操作 手 在 某 采 样 点 的 动态 。 
有 了 负载 识别 ， 式 (14.49) 用 己 个 数据 点 增 广 : 


式 中 ，T 是 一 个 nP xl 的 向 量 ; KÆ nP x 10n 的 
和 矩阵。 

不 幸 的 是 我 们 不 能 应 用 简单 的 最 小 二 乘 估计 ， 
为 K'K 由 于 临近 连 杆 自由 度 的 限制 和 缺少 全 部 力 - 转 


和 矩 的 传 感 而 导致 的 失 秩 变 得 不 可 逆 。 一 些 惯性 参数 完 
全 不 可 辨识 ， 同 时 男 外 一 些 仅 能 以 线性 组 合 的 方式 被 
辨识 。 参 数 的 可 辨识 性 和 怎样 处 理 不 可 辨识 的 参数 将 
在 接 下 来 的 内 容 里 讨论 。 

齿轮 式 电 动机 了 驱动 的 一 个 问题 是 转子 惯性 。 如 果 
未 知 ， 转 子 惯性 可 以 添加 到 连 杆 的 10 个 需要 辨识 的 
惯性 参数 的 名 单 里 “2 。 对 于 大 的 齿轮 转子 ， 转 子 
惯性 在 连 杆 的 惯性 成 分 里 占 主 导 地 位 。 


14.3.3 ”更 复杂 结构 的 连 杆 参数 估计 


在 这 节 里 ， 我 们 介绍 运动 树 〈 生 成 树 ) 机 器 人 
和 运动 闭环 机 器 人 (包括 并 联机 絮 人 ) 的 动态 辨识 
模型 。 这 些 模型 在 惯性 参数 上 是 线性 的 ， 并 且 可 以 用 
类 似 于 式 (14.49) 的 模型 表示 ， 因 此 这 些 参数 可 以 
用 类 似 的 方法 进行 辨识 。 

1. 树 结构 机 器 人 

对 于 一 个 具有 运动 树 型 结构 的 n 连 杆 的 机 器 人 ， 
考虑 连 杆 7 的 惯性 参数 对 不 属于 基 座 到 该 连 杆 的 其 
他 连 杆 的 动态 没有 影响 ,动态 辨识 模型 方程 
(14.48) 必须 做 出 修正 。 对 这 种 结构 ， 与 连 杆 j 贸 
接 的 连 杆 记 为 p G) (i 的 母体 见 第 2 章 )。 它 可 能 
是 一 个 编号 为 i 的 连 杆 ，i<j。 这 样式 (14.48) 中 
和 矩阵 的 列 里 的 非 零 元 素 代 表 连 杆 7 的 惯性 参数 的 系 


IXA, ,XA, QOO ) XA, ES XNA, 
(14. 50) 
式 中 , b 是 连接 连 杆 0 到 连 杆 j 的 链 上 的 第 一 个 连 杆 ， 
因此 p(b) =0。 

由 此 ， 在 树 型 机 器 人 的 式 (14.49) 中 有 : K; = 
01x0o《 如 果 i>)) ,或 者 如 果 连 杆 i 不 属于 连接 连 杆 0 
到 linkj 的 集团 。 这 意味 着 矩阵 天 的 右上 子 阵 有 一 些 
零 的 元 素 。 

我 们 注意 到 串联 结构 是 树 型 结构 的 一 个 特殊 情 
Bb, p(j) 2j-1. UAE REE m, m <j 将 属于 基 座 
到 连 杆 7 的 链 里 。 

2. 闭环 机 器 人 

闭环 结构 的 动态 模型 可 以 使 用 一 个 等 效 的 生成 树 
得 到 ， 打 开 每 个 环 路 的 一 个 关节 ， 然 后 利用 虚 功 
原理 : 


a 0 
t=6'K.b, G- (AH) 
aq, 


RP, g, 是 一 个 Nx1 的 向 量 ， 及 个 主动 关节 角度 
(N 跟 不 同 ， 是 关节 的 总 数 ) ;g, 是 一 个 关于 生成 树 
结构 关节 的 nx1 的 向 量 。 


(14.51) 
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3. 并 联机 器 人 

并 联机 器 人 是 闭环 机 器 人 的 特殊 情况 〈 见 第 12 
章 ) 。 它 由 移动 的 平台 组 成 ， 代 表 终 端 连 杆 ， 用 m 个 
平行 的 腿 与 基 座 连接 。 并 联机 器 人 的 动态 模型 可 以 表 
示 为 0430 


T= SAG, + > (3E) ko, (14. 52) 
i=l ? 


xh, Ko, 代表 腿 i 的 动态 模型 ，K, 是 关于 (a, q, 
qi), q; 的 函数 ; qu; ABI i 角度 向 量 ; AL, 是 平 
台 的 Newton- Euler 空间 力 依据 稍 卡 儿 移 动 平台 变量 
X (14.41) 计算 ; J 是 并 联机 妖 操 作 手 的 雅 可 比 算 
阵 。 通 过 假设 生成 树 结 构 可 以 从 式 (14.51) 获得 式 
(14.52) (生成 树 结构 是 通过 将 移动 平台 从 腿 上 分 离 
来 得 到 的 ) 。 
sk (14.52) 可 以 重 写成 
T= (J'A,(0q,/0,) Ky --(0q,/9q,) Kn) Ppa 
T-K.(0,,»,,0,,4,,d,. Fi) Pour (14. 53) 
其 中 ， 几 .是 机 器 人 的 惯性 参数 向 量 ( 腿 和 平台 ) 。 
$, 


内 
通常 的 情况 下 机 器 人 的 腿 是 相同 的 ， 他 们 的 惯性 参数 
用 内 表示。 辨识 模型 可 以 重 写成 如 下 等 式 ， 它 极 大 
地 减少 了 需要 辨识 的 惯性 参数 的 数量 : 


r= QA Y Gn KS ) (14.54) 


leg 


直 滑 翔 的 并 联机 器 人 的 辨识 参见 参考 文献 [14.31], 
14.4 可 辨识 性 和 数值 调整 


式 (14.49) 中 的 一 些 惯性 参数 不 可 辨识 不 是 说 
它们 本 质 上 不 可 辨识 ， 只 是 试验 设置 使 得 它们 不 可 被 
辨识 。 基 座 附 近 有 限 的 运动 可 能 通过 将 整个 机 器 放置 
到 一 个 六 轴 移 动 平 台 (例如 Stewart- Gough 平台 ) 而 
被 固定 。 事 实 上 ， 对 于 安装 在 高 机 动 性 飞行 (如 
星 ) 上 的 移动 机 器 人 ， 可 能 有 必要 知道 全 部 的 惯 
性 模型 。 可 以 增加 一 个 额外 的 传感器 ， 例 如 加 在 机 器 
AGERE EB ASN I/F 4 f lo^, OR BE 
些 额 外 (但 不 是 全 部 ) 的 惯性 参数 。 

一 个 相似 的 情况 是 运动 学 标定 。 例 如 关节 模型 需 
要 增 广 来 包含 齿轮 的 人 往 心率 、 齿 轮 传输 和 耦合 系数 、 
关节 弹性 、 链 接 弹 性 和 基 座 偏差 ”1。 通 过 使 用 额 
外 的 传感器 来 测量 机 器 人 ， 例 如 ， 在 齿轮 前 后 放置 关 


节 和 角度 传 感 占 来 测量 关节 的 偏差 .就 可 以 辨识 额外 的 
感 兴趣 的 参数 。 额 外 的 经 纬 仪 传 感 可 以 用 来 测量 基 座 
ee 。 

试验 设置 已 定 ， 测 量 结果 不 可 改变 的 情况 ， 我 们 
不 可 以 追 索 未 知 数据 ， 只 能 想 办 法 解决 不 可 辨识 参数 
的 问题 ， 我 们 在 下 一 节 里 谈 到 。 另 一 个 问题 是 参数 可 
能 大 部 分 可 以 辨识 ,但 是 数值 情况 阻碍 了 它们 的 准确 
确定 。 因 此 处 理 一 些 问题 ， 比 如 采集 数据 是 否 足 够 ， 
不 同 单位 和 幅 值 的 影响 等 。 


14.4.1 可 辨识 性 


根据 目标 是 一 个 结构 化 模型 还 是 一 个 预测 模型 ， 
有 两 个 主要 的 处 理 不 可 辨识 参数 的 方法 。 对 一 个 结构 
化 的 模型 ， 目 标 是 找到 最 少 的 参数 集 来 提供 一 个 有 意 
义 的 对 系统 的 物理 描述 ， 通 过 消去 参数 直到 所 有 参数 
是 可 辨识 的 为 止 。 这 是 通过 对 原始 模型 的 每 个 参数 的 
效果 做 出 仔细 的 评估 来 实现 的 。 对 一 个 预测 模型 ， 目 
标 是 匹配 输出 和 输入 ， 这 更 多 的 是 一 个 曲线 拟 合 过 
程 。 这 样 最 后 得 到 的 参数 值 不 一 定 是 有 物理 意义 和 准 
确 的 。 

1. 结构 化 模型 

在 开始 建 模 的 时 候 可 能 可 以 避免 元 余 和 不 可 辨识 
参数 。 其 他 时 候 ， 不 可 能 提前 决定 最 小 参数 集 时 什 
么 ， 因 为 系统 的 复杂 性 或 者 数值 问题 如 测量 错误 或 者 
采集 的 数据 受 限 。 

(1) 预先 参数 消去 法 ”开始 建 模 的 时 候 ， 选 择 的 
参数 代表 立刻 显示 模型 是 否 宛 余 或 者 最 小 。 对 于 运动 
学 标定 ， 最 小 参数 集 包 括 转动 关节 的 4 个 参数 和 柱状 
关节 的 两 个 参数 。 关 于 如 何 给 不 同 的 运动 学 和 传 感 装 
置 设置 DH/Hayati 参数 已 在 14.2.1 节 中 详 述 ， 它 还 
有 一 个 优势 是 参数 集 是 最 小 化 的 (除了 关节 模型 )。 
一 且 完 成 ， 可 以 公式 化 的 应 用 于 任意 机 器 人 系统 。5 
个 或 6 个 参数 的 关节 模型 也 被 提出 ， 或 者 为 了 方便 定 
位 连 杆 坐标 系统 ， 或 者 为 了 容易 建 模 " OO), ATK 
样 的 元 余 参 数 设 定 ， 必 须 有 额外 的 步骤 来 解决 元 余 引 
起 的 数值 问题 ， 例 如 通过 减少 参数 的 数目 。 当 有 复杂 
的 关节 模型 包括 了 之 前 提 到 的 齿轮 效应 ， 导 致 的 大 量 
参数 使 参数 消去 问题 变 得 更 困难 。 确 定 惯性 参数 最 小 
集 也 造成 了 另 一 种 复杂 ， 因 为 大 量 的 参数 不 可 辨识 或 
者 仅 以 线性 组 合 的 方式 辨识 。 此 外 ， 模 型 降 阶 也 是 解 
决 此 类 问题 的 一 个 方法 。 

确定 一 个 最 小 或 基本 参数 集 的 两 个 方法 是 : 

1) 不 可 辨识 参数 或 线性 组 合 参数 的 数值 辨识 。 

2) 象征 性 测定 。 

数值 辨识 包括 用 回归 和 矩阵 运算 降 阶 ， 通过 完整 的 
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机 器 人 结构 


QR 分 解 或 者 奇异 值 分 解 ，*。 如 果 运 动 学 或 动力 学 
模型 是 确 知 的 ， 那么 用 实际 产生 的 数据 进行 的 模拟 会 
产生 一 个 没有 噪声 的 式 (14.3) 中 的 回归 和 矩阵 4。 对 
QR 分 解 ， 回 归 和 矩阵 分 解 为 : 


R 
A-Q 
Oup- Npar-Npar 


AP, Q 是 一 个 Mx MP 的 正 交 矩阵 ; REN... XN, 
的 上 三 角 和 矩阵 ;0w_ ws ww 是 维度 为 MP - Nu X N par 
的 零 矩阵 。 理 论 上 ， 不 可 辨识 参数 p, XERE R 中 
对 角 元 素 R; 为 零 的 情况 。 实 际 上 |R | 被 认为 是 零 ， 
如 果 它 小 于 一 个 极 小 值 Z: 
¢ = MP emax |R; | (14. 56) 

RP, TROL BE | A fe CRT RE DA REH 
合 出 现 ， 根 据 R 的 第 7 行 有 多 少 非 零 元 素 决定 。 这 些 
线性 组 合 的 解 是 任意 的 。 一 种 方法 是 将 线性 组 合 中 所 
有 元 素 变 成 零 而 只 保留 一 个 ， 这 样 结果 就 是 一 个 预测 
模型 而 不 是 结构 化 模型 了 。 

基 座 惯性 参数 的 象征 性 测定 在 参考 文献 [14. 35 ,36] 
中 提出 。 是 用 能 量 计算 方法 ， 连 杆 j 的 总 能 量 用 hj, 
KA, EP h 是 一 个 行 向 量 ,， 称 为 总 能 量 函 数 ， 它 
的 元 素 是 连 杆 j 的 角速度 和 线 速度 加 上 重力 的 运动 学 
表示 。 和 邻近 连 杆 的 递归 关系 可 写成 

h,-h, IA +q, (14. 57) 

SUP, 10 x 10 的 矩阵 二 和 中 的 元 素 是 关于 定义 框架 7 
的 DH 参数 的 函数 ， 而 1 x 10 行 向 量 w 的 元 素 由 线 速 
度 和 角速度 决定 。 这 些 表 达 式 的 详细 情况 可 以 在 参考 
文献 [14.35, 36] 中 找到 。 然 后 建立 分 组 规则 来 寻 
找 准 确 的 参数 线性 组 合 。 

树 形 结构 的 最 小 惯性 参数 集 可 以 使 用 类 似 于 串联 
结构 的 闭环 方案 获得 "9 。 

X (14.51) 中 的 Kg 显示 生成 树 结构 的 最 少 参 
数 可 以 用 来 计算 闭环 结果 的 动态 。 最 少 参 数 通过 惯性 
参数 的 减少 和 分 组 获得 。 然 而 ， 考 虑 矩阵 G， 还 可 以 
消去 或 组 合 额外 的 参数 。 平 行 四 边 形 环 的 结构 可 以 用 
闭环 形式 象征 化 解决 '* 沁 。 对 于 一 般 的 闭环 ， 最 少 
参数 用 数值 方法 例如 QR 分 解 来 确定 。 

并 联机 器 人 的 情况 ,我 们 从 式 (14.52) 推论 出 
腿 的 最 少 参 数 可 以 用 来 计算 Kipi， 通 过 惯性 参数 的 
减少 和 分 组 获得 。 然 而 一 些 其 他 参数 可 以 与 平台 的 参 
数组 合 。 Gough- Stewart 机 器 人 的 最 小 参数 在 参考 文 
献 [14.37] 里 给 出 。 

(2) 数据 驱动 的 参数 估计 “奇异 值 分 解 回 归 和 拢 
阵 的 方法 可 以 显示 哪个 参数 是 不 可 辨识 的 ， 哪 个 是 弱 
辨识 的 ， 哪 个 是 仅 可 辨识 为 线性 组 合 的 。 对 N a 


(14. 55) 


数 ， 忆 个 数据 点 和 每 个 数据 点 的 M 维 输出 测量 ， 回 
归 和 矩阵 4 (14.3) 或 式 (14.7) 可 以 分 解 为 : 

A = UXV' (14. 58) 
RP, U 是 一 个 MP x MP 正 交 矩阵 ; 下 是 一 个 Ne x 
Ni 的 正 交 矩阵 ; X FE MP x N,。 的 奇异 值 矩阵 。 


S 
BUS par: Npar 


IP, S= diag (m, €. 0, 0, 0), RN X 
Ni 排序 奇异 矩阵; py, 是 最 大 非 零 奇异 值 ; jy 是 最 小 非 
零 奇 异 值 。 可 能 有 Na -7 个 为 零 的 奇异 值 jv,, =… = 
Papas 706 
特别 是 当 使 用 复杂 的 关节 模型 包含 了 灵活 度 、 间 际 ， 
以 及 齿轮 偏心 时 ， 不 清楚 是 否 所 有 的 参数 都 可 以 被 估 
计 。 保 持 不 好 的 辨识 参数 将 降低 标定 的 鲁 棒 性 ， 这 些 
参数 由 为 零 或 者 非常 小 的 奇异 值 指出 。 式 (14.7) 
在 式 (14.58) 上 的 扩展 为 : 

Ay = 2 n] Ab) a, 
str, u, Ally, PE U LV 0958 FE, 对 于 零 和 小 
f TEM uu, BUY v; Ab 表示 参数 的 线性 组 合 。 投 影 
的 结果 只 有 一 个 参数 也 是 可 能 的 。 
处 理 的 第 一 步 是 缩放 参数 和 输出 测量 使 奇异 值 互 
相 可 比 。 缩 放 已 经 在 14.4.3 节 中 进行 了 讨论 。 小 的 
奇异 值 信号 代表 有 一 些 不 充分 辨识 的 参数 需要 被 消 
E, Schrüer  ? Jg RR AY EI — A R A n In UE RE I: 
的 条 件数 不 应 该 超过 100 ; 


K(A) -名 
m 


(14. 59) 


(14. 60) 


«100 (14. 61) 


T 


这 是 从 统计 团体 的 经 验 得 出 的 。 如 果 条 件数 超过 
100， 从 最 小 的 开始 检查 奇异 值 ， 它 可 能 为 零 。 

如 果 条 件数 大 于 100， 检 查 对 应 最 小 奇异 值 凡 的 
线性 和 式 (14.60), Flv, 的 元 素 与 Ap 的 元 素 一 一 
对 应 。w 如 果 有 一 个 元 素 j 远 大 于 其 他 ， 则 对 应 此 列 
元 素 的 参数 ep. 候选 被 消去 。 这 个 过 程 趋 于 查 明 完全 
不 可 辨识 的 参数 。 分 离 出 w 的 最 大 元 素 仅仅 在 参数 
预先 缩放 了 的 情况 下 有 意义 。 

一 且 参 数 被 消去 ， 再 次 计算 降 阶 的 回归 和 拖 阵 的 条 
件数 。 这 个 过 程 重复 多 次 直到 回归 矩阵 的 条 件数 小 
于 100。 

前 面 的 过 程 可 以 用 QR 分 解 来 进行 ， 通 过 更 换 式 
(14.55) 中 的 计算 精度 e 为 噪声 水 平 的 值 函 数 。 

2. 预测 模型 

MWR v, 有 多 个 最 大 元 素 ， 它 们 的 幅 值 基本 接近 ， 
则 这 些 参 数 可 能 只 能 在 线性 组 合 中 估计 。 也 会 有 同样 
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多 的 太 小 的 奇异 值 。 通 过 检查 对 应 较 小 的 奇异 值 的 列 


这 个 解 被 称 为 阻尼 最 小 二 乘法 ，A 是 阻尼 因子 。 根 据 


v;， 这 些 线 性 组 合 会 变 得 明显 。 线 性 组 合 可 以 有 任意 
解 ， 也 就 是 说 可 以 把 一 个 元 素 设 为 1， 其 他 都 设 为 0。 
设 定 一 些 参数 为 0 的 结果 是 模型 不 再 是 一 个 结构 化 模 
型 ， 而 是 一 个 预测 模型 。 这 也 可 以 直接 在 没有 消去 参 
数 的 情况 下 进行 。 带 人 奇异 值 分 解 显示 为 : 

(ATA) 'AT=V(S7'0,,,,,MP-N,,,)U' (14.62) 
这 样式 (14.8) WMATA IK , 

Noar T 
Ao = Y tm V; 


可 以 看 到 对 应 小 的 奇异 值 的 不 充分 辨识 的 参数 极 
大 地 扰乱 了 估计 ， 因 为 它 的 权 值 是 1 。 策 略 是 除去 
它们 的 影响 。 如 果 j 是 零 或 者 比 起 最 大 奇异 值 jw K 
非常 小 的 奇异 值 ， 设 1/1 =0。 

不 能 被 很 好 地 辨识 的 参数 在 这 个 过 程 中 简单 的 忽 
略 了 ， 它 们 会 收敛 到 可 辨识 的 参数 集 里 。 然 后 得 到 的 
参数 可 以 在 模型 中 使 用 。 这 种 方法 的 一 个 缺点 是 得 到 
的 参数 不 一 定 与 真实 模型 参数 对 应 。 

3. 合并 预先 参数 估计 

最 小 二 乘 将 参数 值 视 为 完全 未 知 ， 就 是 它们 可 以 
是 -w% ~ +o 的 任何 范围 。 然 而 经 常 有 一 个 很 好 的 人 
计 初 值 ， 例 如 ， 从 制造 商 的 性 能 描述 或 者 在 重 标定 的 
情况 。 混 合 这 些 预 先 的 参考 信息 到 最 小 二 乘 优化 过 程 
RACE Ug m 

假设 优化 的 解 有 ob =) 的 先 验 值 ， 将 此 先 验 表 
达 为 Ip = 向 ， 其 中 工 是 单位 矩阵 ， 把 它 附 加 到 式 
(14.3) 作为 额外 的 一 行 ， 反 映 这 个 先 验 为 


AY (» 
DM 
继续 求解 过 程 ， 我 们 将 e, 看 做 常数 。 重 新 定义 参数 
向 量 为 $B = $$,， 我 们 期 望 它 接近 零 。 有 
[Po 
1) \o 
式 中 , y =y -4 加。 可 能 不 能 确切 地 知道 向， 所 以 
增加 了 一 个 加 权 参 数 和 来 表示 对 这 个 值 的 置信 


B, 则 
A | e y ) 
D. f 


式 中 ，A 越 大 ， 我 们 对 先 验 估计 越 有 信心 。 最 小 二 乘 
的 解 为 


7 T A ‘a "T T y 
die (w anf) KE k ) 


-(A'A +A°I)'A"y (14. 67) 


(14. 63) 


(14. 64) 


(14. 65) 


(14. 66) 


奇异 值 分 解 扩展 该 解 为 
b= DW) IL 
此 一 个 非常 小 的 被 大 的 A 抵消 ; 参数 值 的 先 验 
信息 在 数据 的 信息 里 占 主 导 地 位 ， 就 是 数据 被 忽略 
了 。 因 此 对 阻尼 最 小 二 乘法 ， 不 需要 对 奇异 值 做 明显 
的 处 理 ， 因 为 阻尼 因子 修正 了 奇异 值 。 普 通 的 最 小 二 
乘法 里 ,求解 可 能 被 选择 的 A 幅 值 扰乱 。 
4. 参数 估计 的 置信 和 度 


标定 之 后 ， 参 数 估计 的 协 方差 的 估计 值 ME 可 以 
BFE AAS BY) | PRESS AEE Ay 之 前 被 缩放 ， 
这 是 为 了 平等 的 不 确定 性 ， 没 有 偏 移 ， 误 差 之 间 是 不 
相关 的 。 则 


(14. 68 ) 


M=07(A'A) ^! (14. 69) 
标准 偏差 o 的 估计 值 在 执行 标定 过 程 后 ， 通 过 x? 统 
计 获 得 ! 14. 38,40] , 

Y -(Ay -AAQ)'(Ay -AAÓ) — (14. 70) 
o^ 的 无 偏差 估计 是 G^ m^ 7v, Kr v = MP - N, 称 为 
统计 学 的 自由 度 ; v 是 用 测量 的 总 个 数 MP 减 去 估计 
参数 N,,， 因 为 一 些 测量 将 决定 d. 


估计 值 MM 可 以 被 当做 消去 参数 的 基础 ， 通 过 先 
择 那 些 最 大 的 协 方差。 


可 观测 性 


测量 将 影响 参数 估计 的 准确 性 。 在 运动 学 标定 
里 ,位 姿 组 合 的 特性 可 以 用 可 观测 性 指数 来 衡量 。 在 
惯性 参数 估计 中 ,辨识 轨迹 的 特性 叫做 持续 激 
励 性 ”1 。 不 管 数据 是 在 运动 学 标定 中 静态 的 采集 还 
是 在 惯性 参数 估计 中 动态 的 采集 ， 结 果 就 是 一 堆放 人 
回归 矩阵 的 数字 ， 所 以 最 好 使 用 共同 的 用 语 。 在 统计 
学 里 ， 优 化 实验 设计 理论 引起 几 种 数据 测量 叫做 
alphabet 最 佳 性 "* ”| 。 其 中 最 著名 有 ; 

1) A RÍE: 最 小 化 (ATA) 一 的 迹 来 得 到 回归 
设计 。 

2) D 最 佳 : 最 大 化 (ATA) 的 行列 式 。 

3) ERE: 最 大 化 (4'4) “的 最 小 奇异 值 

4) G 最 佳 : 最 小 化 最 大 预测 协 方差 .并 且 没 有 
奇异 值 形式 的 简单 表达 。 

尽管 依据 实验 设计 文献 还 没有 正式 提出 性 ， 
一 些 提 出 的 用 于 机 器 人 标定 的 可 观测 性 指数 已 经 
alphabet 最 佳 性 相似 的 思想 。A- 最 佳 在 机 器 人 标定 中 
没有 对 应 的 方法 ， 相 反 ， 一 些 提出 的 可 观测 性 指数 也 
没有 alphabet 最 佳 性 对 应 部 分 。 在 参考 文献 [14.43] 
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中 ，E- 最 佳 和 G- 最 佳 被 证 明 对 准确 设计 作用 等 效 。 

Borm 和 Heng 天 5 提出 了 一 个 观测 性 指数 (这 里 
称 为 0, ， 并 且 在 下 面 列举 ) 最 大 化 所 有 奇异 值 的 乘积 : 
y MU), 


0, =~ (14. 71) 
JP. 

这 跟 D- 最 佳 相似 。 基 本 原理 是 0, 表示 Ay 上 超 椭圆 
体 的 体积 ， 由 式 (14.7) 定义 。 当 A 定义 一 个 超 球 
体 时 ， 奇 异 值 代表 轴线 的 长 度 。 因 此 最 大 化 0, 给 出 
最 大 的 超 椭 球体 体积 ， 因 此 奇异 值 很 好 的 聚合 增加 。 
也 可 以 从 广为人知 的 关系 式 det (ATA) =p, u, 得 
到 0。 

最 小 化 4 的 条 件数 作为 可 观测 性 的 一 个 测量 在 
参考 文献 [14.35, 46, 47] 中 被 提出 : 


2" (14. 72) 
0, 测量 超 椭 球体 的 离心 率 ， 而 不 是 它 的 体积 。 不 考 
虑 中 间 量 奇异 值 ， 因 为 最 小 化 条 件数 自动 使 所 有 的 奇 
异 值 变 得 幅 值 相似 ， 而 超 椭 球 体 接近 超 球体 。 

Nahwi 等 ?1 论证 了 最 大 化 奇异 值 , 作为 可 观 
测 性 测量 . 


0, =p, (14. 73) 
这 跟 E- 最 优 类 似 。 其 基本 原理 是 使 最 短 轴 尽 量 长 ， 
而 忽略 其 他 轴 ， 也 就 是 说 ， 优 化 最 差 情 况 。 考 虑 到 下 
面 的 标准 结果 '* “1. 


| Ay | 
HS Age (14. 74) 
或 更 特殊 的 ， 
nlAgls Ay (14.75) 


这 样 最 大 化 人 确保 给 定 的 参数 误差 外 A%| 对 位 姿 误 差 
|| Ay| 有 最 大 的 可 能 影响 。 
Nahvi 和 Hollerbach ^ “提出 了 噪声 放大 指数 O, , 
这 可 以 看 做 是 条 件数 0, 和 最 小 奇异 值 0, 的 结合 : 
9, 
其 原理 是 测量 通过 0, 的 椭圆 和 通过 O. 的 椭圆 的 离 
心率 。 噪 声 放 大 指数 被 论证 为 对 测量 误差 和 模型 误差 
最 敏感 的 指数 。 
Hollerbach 和 Lokhorst! 2 发 现实 践 上 条 件数 和 最 
小 化 奇异 值 给 出 了 差不多 同样 好 的 结果 : 它们 的 相对 
幅 值 几 乎 与 最 终 参数 的 方 均 根 (RMS) 误差 成 正比 。 
可 观测 性 指数 O, 没有 这 么 敏感 也 不 是 与 参数 误差 直 
接 相 关 。 参 考 文献 [14.43] 中 推导 出 一 个 可 观测 性 
指数 和 alphabet 最 佳 性 的 一 般 关 系 : 
O, Z A- optimality = 0, (14. 77) 
他 们 进一步 表明 如 果 j, m1, BBA O,20,; 并 且 


(14. 76) 


Wu, <1, IA 0, 二 0,。 他 们 也 论证 了 0，(D- 最 
佳 ) 一 般 而 言 是 最 佳 指数 ， 因 为 它 最 小 化 参数 的 协 
方差 ， 同 时 也 最 小 化 了 末端 位 姿 的 不 确定 性 。 

1. 最 佳 实验 设计 

可 观测 性 指数 一 般 用 来 决定 需要 采集 多 少数 据 。 
开始 增加 数据 点 时 ， 可 观测 性 增加 ， 然 后 饱和 停滞 。 
之 后 再 增加 数据 不 再 改进 估计 的 质量 。 对 于 运动 学 标 
定 ， 数 据 可 能 随机 的 选择 ， 或 者 采用 优化 设计 方法 极 
大 地 减少 需要 的 数据 的 数目 下。 优化 实验 设计 
通过 测量 增加 或 更 换 数据 点 带 来 的 影响 ”1 。 

2. 激励 轨迹 

对 于 惯性 参数 估计 ， 数 据点 不 是 独立 的 ， 因 为 它 
们 从 一 个 运动 轨迹 得 到 而 不 是 分 离 的 位 姿 。 因 此 问题 
是 产生 什么 样 的 轨迹 类 型 。 工 业 机 器 人 经 常 有 关节 位 
置 点 到 点 的 轨迹 。 通 过 对 这 些 点 的 插值 可 得 到 一 个 连续 
而 平滑 的 轨迹 。 播 值 中 假设 了 每 个 点 的 零 初 值 和 最 终 速 
度 及 加 速度 ， 并 且 使 用 多 项 式 插值 。 通 过 最 小 化 观测 指 
数 ， 在 关节 位 置 、 速 度 、 加 速度 的 限制 条 件 下 ， 使 用 非 
线性 优化 技术 计算 多 项 式 的 系数 就 得 到 激励 估计 9。 

使 用 顺序 激励 过 程 有 可 能 促进 优化 结果 。 结 构 化 
地 激励 小 部 分 参数 的 特别 的 轨迹 ， 比 较 容 易 被 优化 。 
例如 ， 在 速度 限制 下 一 次 移动 一 个 关节 激励 了 摩擦 力 
和 重力 参数 。 在 这 种 方法 里 ， 避 免 了 顺序 辨识 。 然 
而 ， 还 是 采集 所 有 的 数据 进行 一 个 全 局 的 加 权 最 小 二 
乘 估计 更 好 以 2 。 这 个 过 程 避 免 了 估计 误差 的 累积 ， 
并 且 可 以 计算 置信 区 间 ( 见 式 14. 69) 。 
有 一 些 特殊 的 轨迹 被 提出 ， 比 如 正弦 插值 3 ; 
或 者 从 参数 的 贡献 函数 的 频谱 分 析 获 得 的 周期 性 轨 
迹 ' 引 。 这 是 一 个 一 般 性 的 轨迹 设计 策略 ， 对 获得 


正确 的 实验 辨识 非常 重要 0454] 。 
14.4.3 缩放 


参数 估计 的 数值 条 件 可 以 通过 缩放 输出 测量 
(任务 变量 缩放 ) 和 参数 来 改善 。 

1. 任务 变量 缩放 

当 对 未 端 位 姿 误 差 进行 最 小 二 乘 分 析 的 时 候 ， 位 
置 误差 和 方向 误差 必须 混合 考虑 式 (14.22) : 
[Ay I = [A7 pua I+ lA pl (14. 78) 
然而 ， 位 置 误 差 和 方向 误差 有 不 同 的 单位 ， 所 以 不 能 
比较 。 此 外 ， 并 非 所 有 的 位 置 或 方向 的 组 成 部 分 都 具 
有 同等 的 测量 精度 。 

普通 的 最 小 二 乘法 式 (14.8) 平等 的 加 权 所 有 
变量 。 为 了 对 这 些 变量 不 同 的 加 权 ， 一 般 的 解决 方法 
fist (14.7) 左 乘 一 个 缩放 和 矩阵 GU”, 

GAy = GAAÓ 
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Ay =AAd 
sth, Ay = GAy 是 缩放 后 的 输出 向 量 ; A = GA 是 
缩放 过 的 回归 矩阵。 加权 最 小 二 乘法 的 解 为 
Ad = (A'A) " A' y = (ATWA) “'A™WAy 
(14. 80) 
tH, W=G'G, iii, WJe—4 X fü 

缩放 相对 位 置 误差 和 方向 误差 的 一 个 方法 是 使 参 
数 误差 Ad, 对 位 置 误差 或 者 方向 误差 的 效果 相等 。 
令 人 惊讶 的 是 ， 对 于 人 体 尺寸 的 机 器 手臂 ， 公 制 单位 
下 不 用 缩放 就 能 获得 均等 的 效果 。 如 果 o 是 关节 和 角 
HE, 则 * = ro 是 末端 位 置 。 对 于 人 体 尺 十 的 机 器 手 
辟 , r=1m， 所 以 s= 9。 这 样 米 和 弧度 就 直接 可 比 
T, 不 需要 缩放 系数 使 位 姿 参 数 有 意义 。 这 也 可 以 解 
释 为 什么 机 器 人 学 领域 里 一 般 不 考虑 缩放 也 没有 带 来 
什么 后 果 。 如 果 连 杆 很 短 (如 手指 大 小 ) 或 很 长 
(如 挖掘 机 ) ， 情 况 就 不 同 了 。 

PEPE DMA AEE WW 更 普遍 的 方法 是 使 用 可 接受 相 
对 误差 的 先 验 信息 。 这 样 的 信息 由 于 测量 设备 的 特性 
引起 。 假 设 输出 变量 属于 独立 高 斯 噪声 ， 这 样 o? 是 
任务 变量 测量 成 分 Ay, j=1, 0, m 的 标准 偏差 。 
则 单个 对 角 加 权 为 w =1/7, BEX 

R' = diag[ (01), (02)7] 
R = diag( R' ,--- ,R”) 
HEP, HAUBÓBUEW-R-C, REH AEE, 

加 权 最 小 二 乘 估计 的 解 是 

A$-(A'R^A)"A'R^Ay (14.81) 
得 到 的 缩放 输出 变量 Ay; = Ayo 是 无 穷 小 量 。 不 确 
定性 o7 越 大 ， 该 变量 相对 其 他 变量 对 最 小 二 乘 的 解 
影响 越 小 。 标 准 偏差 o? 不 一 定 与 末端 测量 精度 相同 ， 
因为 模型 误差 和 输入 噪声 也 对 输出 误差 有 影响 。 

使 用 标准 偏差 的 加 权 最 小 二 乘 解 又 被 称 为 Gauss- 
Markov 估计 、 推 广 的 最 小 二 乘 估 计 ， 或 者 最 佳 线性 
无 偏差 估计 (BLUE)'U*? 。 它 是 所 有 无 偏 移 估计 值 的 
最 小 协 方差 估计 (参数 误差 )。 重 要 的 一 点 是 Ay 缩 
放 成 分 的 标准 方差 具有 相同 的 尺寸 ， 或 者 协 方差 矩阵 


R=cov(Ay) =I 为 单位 矩阵 。 因 此 误差 向 量 Ay 的 

欧 几 里 德 范 数 是 它 的 尺寸 的 一 个 合理 测量 。 

我 们 经 常 不 那么 清楚 知道 协 方差 矩阵 RR。 在 标定 

过 程 后 ， 标 准 偏差 的 一 个 估计 用 x 统计 获得 ”1. 

XY -(Ay-AAQ)'R (Ay-AAQ) (14.82) 

这 个 方程 与 残留 误差 方程 (14.79) 一 样 , RA W= 
R^ x 在 标定 后 就 是 加 权 残 差 。x? 的 期 望 值 是 


(14. 79) 


EQ’) =v =PK-R (14. 83) 
AH, EGEBIIBI[HSET. tL, AR UM AN sk 
(Ay - AAQ)" 在 足够 测量 的 情况 下 应 该 接近 真实 的 协 
方差 。 我 们 可 以 基于 x 的 值 在 预备 的 校准 后 统一 的 
缩放 R 的 初步 估计 


R-X-R (14. 84) 

v 
式 中 ,RR 是 协 方差 矩阵 的 修正 估计 。 

2. 参数 缩放 

参数 缩放 对 非 线 性 优化 和 奇异 值 分 解 的 适当 收敛 
很 重要 。 如 果 参 数 的 幅 值 很 不 同 ， 那 么 奇异 值 很 难 直 
接 比较 。 同 样 ， 参 数 缩放 能 改善 回归 和 矩阵 4 的 条 件 ， 
避免 不 可 道 问题 。 

TEX (14.79) ÆR A 得 到 任务 变量 缩放 ， 对 4 
右 乘 加 权 和 矩阵 互 得 到 参数 缩放 ”3 ， 


Ay = (AH) (H~'Ad) =AA@ 


式 中 ,缩放 雅 可 比 和 参数 是 4 = AH 和 Ag =H Ad, 
最 小 二 乘 的 解 不 被 参数 缩放 所 改变 ， 但 是 会 被 任务 变 
量 缩放 改变 。 
参数 加 权 最 常用 的 方法 是 列 缩放 ， 它 不 需要 预先 
的 统计 信息 。 定 义 一 个 对 角 和 矩阵 豆 = diag (h, 0, 
hy ) ， 其 中 元 素 为 
T" lla ||  if||a;|| 0 aces 
i 1 if||a,||=0 f 
SUP, a, 是 4 的 第 7 列 。 则 式 (14. 85) 变 成 


(14. 85 ) 


Npar 
a. 
Ay = 之 Ta Al | (14. 87) 
Jm 了 


假设 Ayhas 曾经 归 一 化 ; 则 这 个 值 是 有 意义 的 。 每 个 
a/a | 是 单位 向 量 ， 因 此 每 个 缩放 参数 Ab |a; | Fe 
样 的 大 小 ， 对 Ay 有 同样 的 影响 。 

Schrier451 对 一 个 列 缩放 的 问题 进行 了 辨识 
称 作 参 数 不 良 辨识 ， 导 致 非常 小 的 欧 几 里 德 范 数 。 而 
小 的 欧 几 里 德 范 数 会 导致 大 的 缩放 系数 。 这 些 导 致 了 
A 的 不 确定 性 被 放大 了 。Schrier 提出 了 基于 机 器 人 
的 期 望 误差 的 缩放 ( 像 之 前 在 任务 变量 缩放 里 讨论 
过 的 ) 。 

在 理想 的 情况 下 ， 有 参数 向 量 加 的 期 望 值 和 每 
个 参数 向 量 元 素 的 标准 方差 wy 的 先 验 信息 。 更 一 般 
的 情况 ， 参 数 分 布 用 协 方差 矩阵 M 描述 , 但 是 具体 
的 信息 未 知 ， 可 以 使 用 式 (14.60) 中 的 协 方差 的 估 
计 值 MM。 

如 果 输 出 测量 协 方差 R-! 和 参数 误差 协 方差 M 
都 已 知 ， 可 以 定义 一 个 新 的 最 小 二 乘 最 优 标准 ， 结 合 
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输出 误差 和 参数 误差 产生 新 的 统计 : 
xX =(Ay -AAp)"R™' (Ay -AAQ) + AQ'M ^! A 
(14. 88) 

它 的 解 是 最 小 协 方差 估计 ， 但 不 像 式 (14. 81) 是 有 
局 移 的 

Ad = (ATR^ A « M^) -AIR-IAy (14. 89) 
Kalman 滤波 器 用 递归 的 方法 解决 了 同样 的 问 
题 '*””3|。 当 状态 不 变 时 ， 有 一 个 恒定 的 过 程 ， 并 
且 没 有 处 理 误差 53.51，Gauss- Markov 估计 是 MC! 
的 极限 状况 ， 就 是 没有 关于 参数 的 先 验 信息 的 情况 。 
再 一 次 的 ， 确 定 协 方差 是 一 个 问题 。 像 Gauss- Markov 
估计 一 样 , x^ 的 期 望 值 可 以 在 事后 用 来 一 致 缩放 R 
FI MUSS, 


结论 与 扩展 阅读 


本 章 曾 述 了 标定 机 器 人 的 运动 学 参数 和 惯性 参数 
的 一 些 方法 。 两 个 参数 估计 实例 采用 了 最 小 二 乘法 。 
惯性 参数 在 运动 方程 里 以 线性 方式 出 现 ， 可 以 使 用 普 
通 的 最 小 二 乘法 。 运 动 参数 因为 正弦 和 余弦 的 影响 呈 
非 线 性 ， 所 以 需要 采用 非 线 性 估计 Gauss- Newton 
方法 。 

设 定 校准 方程 有 特定 领域 的 问题 。 对 于 运动 学 标 
E, Hayati 参数 不 得 不 与 Denavit- Hartenberg 参数 混 
合 来 处 理 近 于 平行 的 关节 轴 的 情况 。 校 准 方程 必须 考 
虑 端点 的 测量 和 约束 情况 。 在 详细 研究 可 能 的 关节 序 
列 后 ， 包 括 平行 或 棱 形 关节 ， 一 个 排除 了 可 辨识 性 问 
题 的 最 小 参数 化 可 以 实现 。 

提出 了 校准 指标 作为 运动 学 标定 方法 分 类 。 这 个 
旨 标 通过 计算 相对 移动 性 过 剩 的 传 感 计 算 每 个 位 姿 产 
生 的 方程 个 数 。 关 键 是 所 有 的 校准 方法 可 被 看 做 闭环 
方法 ,在 任何 端点 传 感 系统 可 以 看 做 是 一 个 关节 。 并 
联机 器 人 用 合并 多 个 闭环 的 方式 处 理 。 

对 于 惯性 参数 估计 ， 连 杆 估计 问题 一 直 被 看 做 是 
一 个 有 着 限制 了 传 感 和 运动 的 关节 的 负载 估计 。 递 归 
Newton- Euler JFE 5| th T E = fA AR [JE X B [el UH AR. 
阵 。 对 于 串联 和 拉线 机 器 人 ， 可 以 直接 使 用 最 小 参数 
化 。 数 值 方法 的 提出 解决 了 最 小 参数 化 不 能 达到 时 的 
不 可 辨识 参数 问题 。 这 些 方 法 依靠 回归 和 矩阵 的 奇异 值 
或 者 QR 分 解 。 奇 异 值 可 以 用 来 确定 哪个 参数 不 可 辩 
识 应 该 被 消去 。 作 为 一 种 选择 ， 小 的 奇异 值 可 以 简单 
地 调 零 来 消去 不 良 参数 辨识 的 影响 ， 而 不 用 明显 地 消 


14. 5 


测量 集 对 于 参数 估计 是 否 足 够 的 问题 作为 可 观测 
性 指数 提出 。 可 观测 性 指数 与 实验 设计 中 的 alphabet 
最 优 问题 有 关 。 

最 后 ,测量 或 参数 的 缩放 对 于 一 个 良 态 的 数值 估 
计 是 很 重要 的 ， 而 且 为 了 比较 奇异 值 是 很 关键 的 。 当 
将 测量 和 参数 的 不 确定 性 作为 权重 时 ， 可 以 找到 优化 
最 小 协 方 差 估计 ， 这 与 Kalman 滤波 有 关 。 如 果 这 些 
不 确定 性 未 知 ， 则 可 以 通过 数据 进行 估计 。 


与 其 他 章节 的 关系 


与 最 小 二 乘 和 Kalman 滤波 有 关 的 估计 第 4 章 中 
已 进行 过 讨论 。 通 过 传感器 估计 环境 的 性 质 与 模型 辨 
识 非 常 类 似 。 递 归 地 估计 方法 在 机 器 人 需要 递增 地 更 
新 它 的 世界 模型 的 情况 下 非常 适合 。 对 于 模型 辨识 ， 
使 用 递归 的 方法 并 不 是 特别 有 用 ， 因 为 递归 更 新 的 机 
制 掩盖 了 总 体 数据 数值 问题 。 

奇异 值 分 解 在 第 10 章 和 第 11 章 中 出 现 。 通 过 类 
似 于 可 观测 性 指数 的 方法 分 析 不 同方 向 的 等 效 运动 能 
力 : O, 对 应 可 操作 性 ，0, 对 应 条 件数 ，0, 对 应 最 小 
奇异 值 。 相 比 之 下 ， 标 定 关注 的 是 奇异 值 捕获 的 各 个 
方向 的 好 的 数据 。 第 11 章 采 用 奇异 值 分 解 的 方法 分 
析 宛 余 机 构 。 然 而 参数 估计 一 般 是 一 个 过 约束 的 最 小 
二 乘 问题 (测量 多 过 参数 ) ， 宛 余 结 构 是 没有 约束 的 
(关节 角度 多 过 任务 变量 ) 。 人 代替 信 和 号 传递 辨识 问题 ， 
零 奇异 值 指 示 了 雅 可 比 矩 阵 的 零 空间 。 阻 尼 最 小 二 乘 
法 在 第 11 章 中 用 来 避免 奇异 性 。 就 像 真实 的 参数 被 
标定 中 的 阻尼 最 小 二 乘 扰 乱 ， 轨 迹 被 扰乱 以 绕 过 数值 
条 件 问 题 。 

与 机 器 人 定位 有 关 的 传感器 也 有 传感器 模型 标定 
的 问题 ， 例 如 电位 计 的 增益 。 相 机 校正 在 第 23 章 和 
24 章 中 讨论 。 相 机 模型 能 跟 运 动 学 模型 同时 确 
定 “”””， 包 括 相 机 固有 参数 ， 如 针 孔 模型 (第 4 
章 ) 和 与 相机 安放 位 置 有 关 的 外 部 参数 。 


14. 5.2 扩展 阅读 


1. 螺旋 轴 测 量 

一 种 替代 非 线性 最 小 二 乘法 用 来 估计 运动 学 参数 
的 方法 是 一 类 将 关节 轴 作 为 空间 中 的 线 来 测量 的 方 
法 ， 称 作 螺 旋 轴 测量 "“” 。 一 种 方法 是 圆 点 分 析 ， 一 
次 移动 一 个 关节 来 产生 远 端 测量 点 处 的 一 个 圆 
圈 : 2。 另 一 些 方法 测量 雅 可 比 矩 阵 ， 将 关节 螺旋 


14. 5.1 


去 它们 。 前 者 产生 一 个 结构 化 的 模型 ， 后 者 产生 预测 
模型 。 参 数 的 提前 估计 也 可 以 被 考虑 进来 ， 这 就 是 阻 
尼 最 小 二 乘法 。 


作为 矩阵 的 列 *"。 有 了 关节 轴 的 信息 ， 运 动 学 参 
数 可 以 直接 提取 ， 而 不 需要 非 线 性 搜索 。 这 类 方法 的 
准确 率 可 能 没有 非 线性 最 小 二 乘法 那么 高 。 
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多 指 机 器 人 手 能 够 利用 旋转 和 平移 运动 来 实现 
对 所 抓 取 物体 的 灵巧 操作 。 本 章 将 介绍 多 指 机 器 人 
手 的 设计 、 驱 动 、 传 感 和 控制 。 从 设计 观点 上 看 ， 
由 于 每 个 关节 的 空间 限制 ， 多 指 机 器 人 手 在 驱动 方 
面 受到 很 大 的 约束 。15. 1 节 中 简要 介绍 了 仿 人 来 
端 执 行 器 及 其 灵巧 性 ，15.2 节 中 给 出 了 不 同 驱 动 
方法 的 优 缺 点 。 重 要 的 内 容 有 : 远程 驱动 或 内 置 驱 
动 ， 以 及 关节 数量 与 驱动 器 数量 的 关系 。15.3 节 
介绍 多 指 机 器 人 手 使 用 的 驱动 器 和 传感器 。15.4 
节 介 绍 了 考虑 了 动态 效果 和 摩擦 的 建 模 与 控制 。 
15.5 给 出 了 多 指 机 器 人 手 的 应 用 和 发 展 趋势 。 章 
节 的 最 后 给 出 了 结论 和 扩展 阅读 推荐 。 
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人 和 手 不 仅 能 够 以 各 种 姿势 抓 取 不 同形 状 和 大 小 的 
物体 ， 而 且 能 够 灵巧 地 抓 住 目标 物体 并 进行 各 种 操 
作 。 例 如 通过 一 定 程度 的 训练 ， 一 个 人 可 以 用 手 操作 
棒状 物体 进行 杂 要 、 转 笔 或 者 对 较 小 的 物体 进行 需要 
良好 控制 的 精确 操作 。 显 然 ， 仅 能 够 实现 简单 的 张 开 
与 闭合 动作 的 抓 持 器 不 可 能 做 到 上 面 所 提 到 的 各 种 高 
难度 动作 。 类 似 人 手 的 具有 多 个 手指 的 机 絮 人 手 在 完 
成 上 述 灵巧 动作 方面 具有 很 大 的 潜力 。 此 外 ， 人 手 不 
仅 能 够 抓 持 物体 并 且 对 之 进行 各 种 操作 ， 还 对 物体 的 
表面 情况 、 温 度 和 重量 等 特点 具有 感知 能 力 。 与 真实 
的 人 手 进行 类 比 ， 我 们 希望 机 器 人 手 也 具有 类 似 的 对 
环境 的 感知 功能 。 通 过 在 机 器 人 手 上 应 用 先进 的 传 感 
装置 ， 再 结合 适当 的 机 器 人 手 控制 算法 ,或 许 能 够 提 
高 机 器 人 手 与 周围 环境 的 交互 能 力 ， 使 它 能 主动 地 探 
索 周 于 环境 ， 采 集 到 有 关 周 围 事物 的 各 种 信息 ， 完 成 
简单 的 工业 夹 持 圳 几乎 不 可 能 实现 的 工作 。 由 于 上 面 
所 提 到 的 各 种 原因 以 及 其 他 一 些 因 素 的 影响 ， 近 些 年 
来 ， 多 指 机 器 人 手 的 研究 已 经 成 为 了 科研 领域 内 的 一 
大 热点 。 

20 世纪 70 年 代 晚 期 ，Okada JE T tH BE £8 4H iff 
传动 系统 研制 出 了 一 种 多 指 机 器 人 手 ， 这 种 机 器 人 手 
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能 够 实现 开 合 螺母 的 动作 “" 。20 世纪 80 年 代 早 
期 ， 两 款 经 典 的 多 指 机 器 人 手 问 世 ， 它 们 分 别 是 由 
Stanford 研制 的 JPL 手 和 由 MIT 研制 的 Utab/MIT 手 。 
这 两 款 手 至 今 仍 被 看 做 是 多 指 机 器 人 手 研 究 领域 的 里 
程 碑 。 自 那 以 后 ， 世 界 各 地 的 很 多 研究 机 构 相 继 设 计 
研发 了 各 式 各 样 的 多 指 机 器 人 手 。 这 中 间 ， 颇 具名 气 
的 有 DLR 手 、MEL F, ETL F., Darmstadt F., 
Karlsruhe F, Bologna F, Barrett 手 、Yasukawa F, 
Gifu 手 、U- Tokyo 手 和 Hiroshima 手 等 。 

在 研制 多 指 机 器 人 手 的 时 候 ， 不 可 避免 地 会 遇 到 
以 下 的 问题 : 手指 的 自由 度 及 运动 学 结构 、 手 部 动作 
的 拟人 程度 、 手 部 驱动 方式 的 选择 、 传 动 系统 的 设 
计 、 传 感 器 的 使 用 与 布置 、 控 制 算法 以 及 手 部 与 上 肢 
的 结合 等 。 这 些 问 题 都 会 在 本 章 提 及 。 


15.1 基本 概念 


Ki 


在 讲述 机 器 人 手 的 设计 和 使 用 之 前 ， 有 必要 对 有 
关于 机 器 人 手 的 一 些 基 本 概念 进行 说 明 。 特 别 是 要 讲 
清 如 “灵巧 性 ”和 “拟人 程度 ”这 样 的 术语 在 机 器 
人 和 手 研究 领域 的 特定 含义 。 
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机 器 人 结构 


15.1.1 仿 人 末端 执行 器 


在 机 器 人 手 研究 领域 中 拟人 程度 这 个 术语 是 指 机 
器 人 手 在 形状 、 大 小 、 颜 色 和 手 部 温度 等 方面 与 真实 
人 和 手 的 相似 程度 。 从 字面 意思 上 理解 ， 拟 人 程度 这 个 
概念 只 涉及 手 的 外 部 特征 而 并 不 要 求 手 具 备 强大 的 
持 功 能 。 而 灵巧 性 则 特 指 手 部 具有 的 实际 功能 而 不 涉 
及 手 的 外 观 或 者 美学 特征 。 所 以 ， 拟 人 程度 和 灵巧 性 
在 机 器 人 领域 是 两 个 完全 独立 的 概念 。 

实际 上 ， 存 在 着 灵巧 性 很 低 但 具有 一 定 拟人 
程度 的 机 器 人 手 ， 但 利用 它们 只 能 完成 一 些 简 单 


对 人 手 功能 性 的 模仿 更 为 重要 。 
下 面 的 两 个 指标 用 来 评估 机 器 人 手 的 灵巧 程度 的 


1) 抓 持 能 力 : 机 器 人 手 抓 持 不 同 大 小 和 形状 的 
物体 的 能 力 。 
2) 理解 能 力 : 机 器 人 手 在 抓 持 物体 的 过 程 中 通 
过 与 周围 环境 的 接触 ， 准 确 获 得 有 关 周 围 环境 信息 的 
能 力 。 
从 这 个 意义 上 来 讲 ， 人 手 既是 一 个 输出 装置 也 是 
一 个 输入 装置 。 当 机 絮 人 手 作为 输出 装置 时 ， 它 能 够 
提供 足够 的 抓 持 力 抓 持 物体 ， 进 而 抓 住 物体 并 对 之 进 


的 抓 持 任务 '”。 类 似 地 ， 也 存在 灵巧 程度 很 高 、 
能 够 完成 高 难度 动作 的 机 器 人 手 , 但 是 它 的 外 观 
却 根本 不 像 人 手中 。 所 以 对 机 器 人 手 的 拟人 性 
来 说 ， 它 的 灵巧 程度 既 不 充分 也 不 必要 ,但 具备 
很 高 的 灵巧 性 的 人 手 为 机 器 人 手 的 设计 提供 了 很 
好 的 外 观 蓝本 。 
由 于 诸多 原因 ， 很 多 科研 人 员 将 拟人 性 作为 机 器 
人 手 的 设计 目标 之 一 ， 现 将 各 类 原因 总 结 如 下 : 
1) 在 很 多 只 有 机 器 人 或 者 人 类 才能 进行 工作 的 
环境 中 ， 有 具有 一 定 拟人 程度 的 机 器 人 手 能 够 代替 人 手 
进行 工作 。 

2) 机 器 人 手 能 够 为 工作 人 员 遥 控 、 模 仿 操作 者 
的 动作 进而 开展 工作 。 

3) HRSA, ROL ABA SA 
类 似 的 形态 及 动作 。 

4) 在 假肢 制作 领域 ， 假 肢 外 观 上 的 拟人 性 也 是 
必 不 可 少 的 。 近 些 年 来 ， 机 器 人 手 在 假肢 制作 领域 也 
取得 了 一 些 成 就 ， 如 今 的 假肢 已 经 能 够 被 看 成 是 一 个 
完整 的 机 器 人 系统 。 

由 于 机 器 人 手 灵 巧 程度 这 个 概念 的 抽象 性 ， 和 
难 对 某 个 机 器 人 系统 的 灵巧 程度 进行 量化 或 有 效 自 
测定 ， 但 机 器 人 手 的 拟人 程度 却 能 通过 一 些 客观 上 
比较 进行 度量 。 影 响 机 器 人 手 拟 人 程度 的 因素 
要 有 

1) 运动 学 特点 : 主要 形态 元 素 (手指 、 可 侧 摆 
的 拇指 和 手掌 ) 的 形态 。 

2) 表面 特征 : 接触 表面 的 延展 性 和 光滑 程度 ， 
这 反映 了 机 器 人 手 通 过 可 用 关节 的 表面 与 物体 实现 接 
触 的 能 力 以 及 其 表面 的 形态 。 

3) RY: 既 包 括 手 的 整体 大 小 也 包括 手指 各 个 
关节 间 长 度 的 比例 关系 。 


15.1.2 机 器 人 手 的 灵巧 性 
较 之 机 器 人 手 对 真实 人 手 的 外 观 方面 的 模仿 ， 其 
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行 操 作 。 而 作为 一 个 输入 装置 ， 机 器 人 手 能 够 对 某 个 
未 知 的 环境 进行 探索 并 获得 与 之 相关 的 信息 。 通 过 设 
计 ， 机 器 人 手 也 可 以 具有 与 人 手相 似 的 功能 特点 。 事 
实 上 ， 要 想 让 机 器 人 手 也 能 在 一 个 未 知 的 环境 中 完成 
复杂 的 任务 需要 具有 灵巧 控制 功能 的 机 器 人 系统 作 它 
的 “大 脑 ”。 

一 种 被 广泛 接受 的 定义 认为 ， 机 器 人 手 的 灵巧 性 
指 的 是 它 能 够 根据 所 处 工作 环境 的 需要 主观 地 改变 被 
操作 物体 的 形 貌 、 位 置 等 特征 的 程度 。 大 体 来 说 ， 由 
一 个 合适 的 机 絮 人 控制 系统 操纵 的 具有 一 定 灵巧 程度 
的 机 器 人 手 便 能 够 自动 地 完成 具有 一 定 复杂 程度 的 任 
务 。 在 一 些 文献 中 也 对 机 器 人 手 的 灵巧 性 做 出 了 完整 
科学 的 论述 中。 
虽然 灵巧 性 这 个 词 自身 拥有 非常 明确 的 定义 ， 根 
据 能 够 完成 任务 的 复杂 程度 及 危险 性 对 机 器 人 手 的 灵 
巧 程度 进行 分 级 也 是 有 必要 的 。 机 器 人 手 的 灵巧 性 可 
大 致 分 为 抓 持 动 作 灵 巧 性 和 内 部 操纵 灵巧 性 两 个 
JH H 
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抓 持 动作 灵巧 性 指 的 是 机 器 人 手 抓 持 形状 不 变 的 
物体 的 能 力 。 

内 部 操纵 灵巧 性 是 指 形状 可 变 的 被 抓 持 物体 在 机 
器 人 手 的 工作 空间 内 的 受 约束 的 运动 。 

一 些 文献 中 论述 了 对 以 上 两 个 大 分 支 的 进一步 
dg. 
虽然 科学 界 对 机 器 人 手 的 灵巧 性 已 经 有 了 明确 的 
定义 ， 但 是 如 何 将 其 量化 仍旧 是 科学 家 们 争论 的 焦 
点 。 影 响 机 器 人 手 灵巧 性 的 因素 很 多 ， 这 中 间 包 括 手 
的 外 部 特征 、 应 用 的 传 感 天、 控制 算法 、 任 务 执行 策 
略 等 。 


15.2 机 器 人 手 的 设计 


即使 在 机 器 人 手 的 运动 学 结构 、 形 状 和 尺寸 已 
经 确定 的 情况 下 ,不 同人 设计 出 的 机 器 人 手 也 会 由 


第 15 章 机 器 人 手 275 


于 设计 理念 的 不 同 而 不 同 。 机 器 人 手 设 计 过 程 中 的 
一 个 关键 问题 就 是 驱动 系统 与 传动 系统 的 设计 。 由 
于 机 器 人 手 内 部 空间 的 有 限 性 ， 这 个 问题 显得 尤为 
重要 ， 总 的 来 说 ， 拟 人 的 形态 及 大 小 将 是 设计 追求 
的 主要 目标 。 

需要 指出 的 是 ， 由 于 机 器 人 手 的 机 械 装置 设计 方 
案 层 出 不 穷 ， 本 文中 所 介绍 的 也 只 是 这 一 系列 设计 方 
案 中 相对 重要 的 几 个 方案 ， 因 此 本 节 并 不 是 对 所 有 机 
器 人 手机 械 装置 的 完整 综合 性 论述 。 


15.2.1 驱动 器 布置 与 传动 


为 了 驱动 机 器 人 手 部 关节 ， 需 要 在 其 中 放置 一 定 
数量 的 驱动 器 ， 驱 动 器 的 放置 方式 通常 有 以 下 两 种 : 

1) 在 手 部 关节 周围 就 近 安 置 驱动 器 ， 可 以 将 驱 
动 顺 设置 在 手指 中 或 者 直接 将 驱动 器 与 关节 连接 。 

2) 将 驱动 电动 机 设置 在 手掌 中 或 者 前 辟 上 ， 这 
种 情况 下 电动 机 的 运动 须 通 过 传动 系统 传递 到 手 部 
关节 。 

1. 内 置 驱动 方案 

驱动 右 内 置 情 况 下 ， 电 动机 被 直接 设置 在 手指 关 
节 中 或 者 设置 在 与 被 驱动 关节 相连 的 两 个 指 段 之 一 
中 ， 所 以 驱动 器 内 置 方案 可 以 被 归结 为 两 种 : 
1) 直接 驱动 式 : 电动 机 直接 安放 在 手指 关节 
中 ， 电 动机 与 手指 关节 之 间 没 有 传动 元 件 。 
2) 内 置 于 指 段 : 电动 机 被 设置 在 与 被 驱动 关节 
相连 的 两 个 指 段 之 一 中 。 

驱动 器 内 置 方案 简化 了 手指 关节 部 位 的 机 械 结 
构 ， 从 而 降低 了 整个 手 部 传动 装置 的 复杂 程度 。 更 加 
值得 一 提 的 是 这 种 方案 使 得 各 手指 关节 在 运动 学 上 相 
互 独立 。 通 常情 况 下 ， 手 指 的 尺寸 会 受到 驱动 器 大 小 
的 影响 ， 并 且 由 于 各 种 技术 上 的 原因 ， 很 难 使 机 器 人 
手 同 时 具有 人 和 手 的 尺寸 和 人 手 强大 的 抓 持 能 力 。 而 
且 ， 由 于 驱动 器 会 占据 手指 中 的 很 大 一 部 分 空间 ， 其 
他 的 像 传 感 希 和 外 壳 层 这 类 元 件 也 很 难 再 放 和 手指 
中 。 此 外 ， 驱 动 费 内 置 方案 中 电动 机 的 存在 加 大 了 手 
指 的 重量 ， 这 一 点 也 必 将 降低 手指 的 灵活 度 和 敏 
捷 度 。 

然而 ， 近 来 驱动 顺 技 术 方 面 取得 的 进展 使 得 科学 
家 能 够 直接 将 一 个 大 小 合适 、 并 且 输 出 力矩 足够 的 电 
动机 设置 在 手指 关节 。 采 用 驱动 器 内 置 方式 的 机 器 人 
FA DLR 手中 ，ETL 手 、Karlsruhe 手 、Yasukawa 
手 、Barrett F, Gifu F. U- Tokyo FFI Hiroshima F, 
由 于 这 种 驱动 器 设置 形式 中 驱动 器 部 分 并 不 包括 柔性 
的 类 似 胁 绳 的 传动 件 ， 所 以 可 以 使 用 非 柔 性 的 传动 系 
统 使 得 传动 过 程 稳定 从 而 实现 有 效 的 抓 持 “| 。 这 类 


| 


驱动 器 设置 形式 存在 的 一 个 问题 是 机 器 人 手中 电源 线 
和 信号 导线 的 布线 。 由 于 位 于 手指 远 关节 的 导线 的 影 
响 ， 使 得 它 在 抓 持 过 程 中 相对 于 基部 关节 的 力矩 减 
小 ， 最 终 导致 控制 系统 对 远 关 节 控 制 精度 和 有 效 性 降 
低 。 由 此 可 见 ， 手 指 中 导线 的 影响 对 远 关 节 的 影响 要 
比 对 近 关 节 的 大 。 

2. 远程 驱动 方案 

远程 驱动 是 不 同 于 驱动 器 内 置 方案 的 另 一 种 驱 
动 器 设置 方式 。 远 程 驱动 方案 中 驱动 器 位 于 与 被 驱 
动 关 节 直 接 相 连 的 指 段 外 部 。 这 种 方案 需要 一 个 传 
动 装置 ， 在 机 器 人 手 抓 持 物体 的 过 程 中 它 将 驱动 器 
的 运动 传递 到 被 驱动 关节 。 值 得 注意 的 是 ， 这 种 方 
案 中 必须 考虑 的 男 一 个 问题 是 各 驱动 关节 之 间 的 运 
动 耦合 。 手 部 的 远程 驱动 方案 在 生物 体 较 为 普遍 ， 
人 手 的 运动 就 属于 这 种 驱动 方式 。 人 的 手指 关节 被 
位 于 手掌 或 者 前 臂 中 的 肌肉 驱动 做 出 各 种 动作 。 这 
种 类 似 人 手 的 驱动 方案 在 UB 手 和 Robonaut 手中 被 
aee. 

机 器 人 手 远 程 驱动 系统 可 以 根据 所 采用 的 传动 件 
的 特点 分 为 两 种 : 柔性 件 传动 与 非 柔 性 件 传动 。 

1) 柔性 件 传动 。 柔 性 件 传动 基于 传动 元 件 之 间 
柔性 的 连接 ， 即 线性 形变 式 的 或 者 旋转 式 的 连接 ， 通 
过 改变 传动 路 径 适 应 手 在 运动 过 程 中 动作 的 改变 。 线 
性 形变 式 柔 性 件 传动 利用 既 能 承受 拉力 〈 较 常见 ) 
又 能 够 承受 压力 的 柔性 元 件 实现 传递 运动 的 目的 。 这 
种 传动 形式 还 可 以 被 进一步 划分 为 传动 轮 -柔性 件 
(例如 腿 强 、 链 条 和 同步 带 ) 传动 和 套 接 件 -柔性 件 
(ESE HARUN IEE) 传动 。 可 旋转 式 柔 性 
传动 系统 利用 旋转 轴 将 驱动 器 的 运动 传递 给 手指 关 
他， 最 终 通 过 位 于 关节 附近 的 传动 结构 〈 锥 齿轮 或 
者 涡轮 ) 驱动 关节 转动 。 

2) 非 柔 性 件 传 动 。 非 柔性 件 传 动 系统 主要 由 连 
杆 或 齿轮 这 类 元 件 构 成 。 这 种 传动 形式 可 以 依据 传动 
轴 之 间 的 平行 或 垂直 关系 进行 进一步 的 划分 ， 例 如 蜗 
轮 蜗杆 传动 、 锥 齿轮 传动 等 。 


15.2.2 ”了 驱动 架构 


VA EUR FE SK JI de d np EUM FH T A IDE SB LES 
上 ， 例 如 在 手指 的 一 个 关节 上 和 采用 一 个 或 者 多 个 驱动 
器 并 且 让 这 些 驱动 咒 以 不 同 的 方式 工作 。 

用 NN 来 代表 机 器 人 手 拥 有 的 关节 总 数 (不 包括 
腕 部 关节 ) ， 用 W 代表 用 于 直接 或 者 间接 的 方式 驱动 
手指 关节 的 驱动 器 数目 。 根 据 驱 动 装置 与 传动 装置 之 
间 的 关系 ， 机 器 人 手 的 驱动 方案 可 以 被 划分 为 三 种 : 

1) M«N; 机 器 人 手中 某 些 关 节 是 被 动 的、 耦合 


= 
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的 或 者 欠 驱 动 的 。 

2) M=N: 每 个 关节 都 拥有 只 属于 自己 的 驱动 
器 ， 手 部 没有 被 动 的 、 耦 合 的 、 或 者 欠 驱 动 的 关节 。 
3) M>N: 某 些 手 部 关节 拥有 不 止 一 个 驱动 器 。 
驱动 装置 结构 很 大 程度 上 决定 于 机 器 人 手 所 使 用 
的 电机 的 类 型 。 特 别 地 ， 说 一 说 以 下 两 种 主要 的 驱动 

1) 单 向 驱动 。 这 种 驱动 器 每 个 电动 机 只 能 够 产 
生 朝 着 一 个 方向 的 转动 ， 驱 动手 指 朝 着 一 个 方向 运 
动 。 而 手指 男 一 个 方向 的 运动 需要 外 围 的 被 动 系统 
(例如 弹簧 ) 或 者 主动 系统 (例如 驱动 器 ) 提供 ， 基 
于 腿 强 传动 系统 的 机 器 人 手 就 属于 这 种 形式 ; 

2) 双向 驱动 。 这 种 驱动 器 每 个 电动 机 能 够 朝 着 
正 反 两 个 方向 转动 ， 可 以 单独 地 驱动 一 个 手指 关节 也 
可 以 与 其 他 驱动 器 配合 完成 驱动 手指 关节 的 目的 。 这 
种 情况 下 可 以 利用 功能 性 的 元 余 驱动 器 来 实现 手 部 的 
高 难度 驱动 技术 ， 例 如 推拉 结合 驱动 。 

以 上 的 每 一 种 形式 都 可 以 被 进一步 地 细 分 ， 下 面 
将 简要 地 叙述 一 些 常 用 的 驱动 装置 和 传动 装置 类 型 。 

1. 单 向 驱动 与 被 动 回复 元 件 结合 式 

如 图 15. 1a 所 示 ， 像 弹簧 这 样 的 被 动 元 件 ， 能 够 
在 机 器 人 手 被 驱动 实现 抓 持 物体 的 过 程 中 储存 能 量 ， 
并 在 手 部 松 开 物体 过 程 中 将 这 部 分 能 量 释放 。 这 种 结 
构 简 化 了 手 部 在 抓 持 物体 时 的 驱动 装置 ， 但 同时 又 需 
要 另外 的 电动 机 为 手 部 松 开 物 体 这 一 动作 提供 动力 。 
它 的 另 一 个 缺点 在 于 抓 取 过 程 中 电动 机 能 量 的 损耗 以 
及 弹簧 硬度 较 低 时 回应 的 带宽 受到 限制 。 

2. 对 抗 型 单 向 驱动 式 

如 图 15. 2b 所 示 ， 图 中 两 个 驱动 器 朝 着 不 同 的 方 
向 拉动 同一 点 。 这 种 方案 中 被 驱动 的 机 器 人 手 如 果 含 
有 NN 个 关节 ， 那 么 需要 2NN 个 驱动 器 提供 动力 。 这 种 
方案 中 电动 机 数目 繁多 导致 了 手 部 结构 的 复杂 。 但 另 
一 方面 ， 由 于 驱动 同一 个 关节 的 一 对 驱动 器 能 够 以 不 
同 的 拉力 的 同时 拉动 关节 ， 因 此 能 够 实现 在 关节 上 产 
生 驱 动力 矩 的 同时 进行 预 加 载 ， 这 种 特点 可 以 使 手 部 
完成 复杂 的 动作 。 

1) 优点 : 能 够 根据 抓 持 过 程 调整 手指 关节 刚 
度 ， 从 而 减 小 摩擦 力 在 手 部 快速 抓 持 过 程 中 对 抓 持 过 
程 的 影响 ， 对 每 个 关节 独立 的 位 置 和 拉力 控制 ， 能 够 
补偿 不 同 的 驱动 路 径 的 长 度 ; 这 种 形式 是 驱动 关节 的 
最 灵活 的 解决 方案 。 

2) 缺点 : 需要 用 于 反 向 拉动 关节 的 驱动 器 ; 不 
论 采 取 何 种 驱动 器 布置 方案 ， 都 很 难为 每 一 个 关节 在 
手中 设置 两 个 驱动 器 ; 控制 系统 复杂 ; 花费 更 多 。 


图 15.1 两 种 驱动 方式 
a) 单 向 驱动 与 被 动 回复 元 件 结合 式 


b) 对 抗 型 单 向 驱动 于 


3. 依据 驱动 网 概念 的 单 向 驱动 式 

这 种 形式 源 自生 物 系 统 ， 迄 今 为 止 仅 有 一 些 初步 
的 研究 ， 尚 未 成 功 地 应 用 于 机 器 人 手 上 。 这 种 类 型 的 
机 器 人 手中 ，N 个 关节 由 M 个 驱动 器 带动 ，N 和 MM 
的 关系 为 : N«M <2N。 借 由 适宜 的 驱动 网 ， 每 个 驱 
动 右 驱动 多 余 一 个 的 手指 关节 。 

1) 优点 : 能 够 根据 抓 持 过 程 调整 手指 关节 刚 
度 ， 从 而 减 小 摩擦 力 在 手 部 快速 抓 持 过 程 中 对 抓 持 过 
程 的 影响 ;， 相 对 于 有 2NN 个 驱动 器 的 方案 ， 电 动机 的 
数目 有 所 减少 。 

2) 缺点 : 需要 用 于 反 向 拉动 关节 的 驱动 器 ; F 
部 的 动力 学 结构 复杂 进而 导致 手指 控制 系统 复杂 化 。 
图 15. 2 中 显示 了 最 简单 的 N+1 型 的 驱动 网 络 结 
构 。 这 个 实例 中 ， 所 有 的 电动 机 都 是 相互 耦合 的 ， 它 
们 中 间 任 意 一 个 电动 机 的 损坏 都 会 导致 整个 系统 的 
HEIR 


a) b) c) 


图 15.2 远程 驱动 
a) NAY b)2N 型 c) N+1 型 


4. M«N 的 双向 驱动 式 

这 种 情况 下 ， 了 驱动 絮 的 数目 少 于 手 部 关节 的 数 
目 。 这 一 类 驱动 模式 可 分 为 下 面 两 个 子 类 : 

1) 所 有 的 关节 都 是 耦合 的 ， 这 种 情况 下 该 子 系 
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统 的 自由 度 为 1。 

2) 根据 主动 或 被 动 的 选择 性 子 系统 ， 电 动机 选 
择 性 地 驱动 关节 转动 。 
第 一 种 子 类 还 可 以 被 进一步 细 分 : 

(D 固定 式 耦 合 关节 。 在 这 种 类 型 的 手指 中 ， 一 
个 电动 机 能 够 驱动 多 个 关节 转动 ， 这 些 多 个 关节 之 间 
通过 非 柔 性 的 传动 装置 连接 ， 它 们 之 间 保 持 一 定 的 传 
动 比 。 利 用 齿轮 传动 可 以 实现 耦合 功能 ， 具 体 实 现 方 
式 叙 述 如 下 : 如 图 15. 3a 所 示 ， 电 动机 直接 驱动 第 一 
指 段 运动 ， 主 动 轮 固 接 于 基 座 ， 从 动 轮 和 第 二 指 段 固 
接 于 第 二 关节 轴 ， 主 动 轮 与 从 动 轮 之 间 为 齿轮 传动 机 
构 。 另 外 一 种 常见 的 能 实现 看 合 运动 的 装置 是 腿 绳 传 
动 装置 ， 如 图 15. 3b 所 示 。 


TR 89 [8] az it 


b) 
图 15.3 [DESOB AX 
a) 齿轮 构成 的 双向 转动 电动 机 N = M 型 传动 机 构 
b) 胁 强 构 成 的 双向 转动 电动 机 N = M. 型 传动 机 构 


在 机 器 人 手 的 设计 中 使 用 耦合 传动 机 构 的 最 大 的 
优点 在 于 能 够 事先 确定 并 控制 手指 第 二 指 段 的 位 置 和 
和 运动。 耦合 型 手 的 最 大 缺点 在 于 不 能 够 适应 被 抓 持 物 
体 的 形状 ， 这 会 导致 厢 合 型 手 在 一 些 情况 下 抓 取 过 程 
不 够 稳定 。 

D 非 国定 式 耦合 关节 。 这 种 方案 需要 从 驱动 机 
构 以 及 可 形变 的 被 驱动 关节 。 从 驱动 机 构 是 指 驱动 吕 
数目 小 于 自由 度 的 机 构 。 应 用 在 机 器 人 手指 上 ， 从 驱 
动 通常 意味 着 与 被 抓 持 物 的 形状 相 适 应 ， 例 如 从 驱动 
手指 可 以 包围 被 抓 持 物 体 并 且 通 过 较 少 的 驱动 顺便 能 
适应 其 形状 。 为 确保 系统 的 稳定 性 ， 欠 驱动 系统 中 需 
引入 弹性 元 件 〈 常 用 弹簧 ) 及 机 械 约 束 。 对 于 一 个 
正在 接近 物体 的 手指 ， 其 形态 决定 于 物体 相关 的 外 部 
约束 。 图 15. 4 为 一 种 双 自 由 度 欠 驱动 手指 ， 这 种 手 
指 由 底部 连 杆 驱 动 ， 用 弹簧 保持 手指 处 于 完全 伸展 状 


态 。 机 械 约束 用 于 使 弹簧 作用 下 的 各 指 段 在 没有 外 力 
时 保持 平衡 。 因 为 各 关节 不 能 独立 控制 ， 手 指 的 行为 
就 决定 于 最 初 的 设计 参数 (几何 或 刚度 特性 ) E 
此 ， 设 计 参 数 的 选 定 尤为 重要 。 


4429 


图 15.4 欠 驱 动手 指 抓 取 过 程 


另 一 种 方式 是 通过 各 种 可 变形 的 连接 来 耦合 两 
个 相 邻 关 节 的 运动 。 其 特点 在 于 引入 了 有 一 定 柔 性 
的 运动 链 系 以 适应 抓 取 物体 的 形式 。 图 15. 5 就 是 一 
个 基于 此 方式 运作 的 机 构 的 简单 实例 。 从 结构 上 来 
看 ， 它 类 似 于 基于 固定 耦合 式 关 节 ， 主 要 的 不 同 仅 
在 于 它 添加 了 一 个 弹簧 以 增加 腿 绳 的 延展 性 。 外 力 
作用 于 末端 连 杆 时 ， 弹 簧 使 得 第 一 根 和 第 二 根 连 杆 
之 间 能 够 进行 相对 运动 。 这 种 方式 应 用 广泛 ， 如 ) 
为 人 知 的 DLR 手 。 这 种 方式 的 优势 主要 在 于 它 对 于 
物体 形状 的 适应 性 。 如 何 确 定 可 变形 构件 的 刚度 以 
同时 保证 较 强 的 抓 取 力 与 较 好 的 形状 匹配 是 设计 中 
的 主要 问题 。 


DEARA EEA 


Y 第 二 指 段 
图 15.5 非 固定 式 耦 合 关 节 


© 单 电动 机 选择 性 驱动 关节 。 通 过 这 种 方式 ， 
由 一 个 〈 较 大 的 ) 电动 机 产生 的 运动 传递 并 分 配 到 
多 个 关节 。 各 关节 的 驱动 和 控制 通过 一 种 类 似 自 动 或 
受 控 离 合 器 的 可 插入 离合 装置 实现 的 。 

5. M=N 的 双向 驱动 式 

这 是 一 个 非常 普遍 的 情形 ， 每 个 关节 各 个 方向 上 
的 运动 由 同一 个 驱动 器 驱动 。 这 种 方式 在 各 方向 是 相 
似 (甚至 相同 ) 的 ， 但 必须 注意 回程 间隙 的 影响 ， 
同时 一 般 有 必要 对 传动 系统 进行 预 加 载 。 对 于 有 妥 强 
之 类 的 弹性 构件 构成 的 传动 装置 ， 预 加 载 是 必需 的 。 
此 外 ， 由 于 卷 绕 在 电动 机 带 轮 上 的 腿 强 与 未 卷 绕 的 
妥 强 长 度 相同 ,闭环 传动 系统 要 求 妥 强 路 径 总 长 为 常 
数 。 这 涉及 长 度 补偿 机 制 (如 滑轮 组 、 凸 轮 等 )， 
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因为 每 次 手指 的 几何 位 置 的 变化 都 会 引起 腿 绳 的 差 
动 位 移 。 尽 管 有 上 述 复杂 性 的 限制 ， 这 种 通过 简单 
的 带 轮 - 胁 强 (UB 手 ，Okada 手 等 ) REGE- ME 
(Salisbury F, DIST 手 等 ) 作用 的 驱动 方式 仍 被 广 
泛 运用 ， 这 种 方式 原理 简单 ， 但 存在 妥 强 与 靖 套 之 


间 有 摩擦 等 问题 ， 在 这 种 情形 下 ， 过 高 的 预 加 载 是 
很 困难 的 。 


15.3 ”驱动 与 传 感 技术 


本 节 将 对 机 器 人 手 驱动 与 传 感 技术 方 面 的 主要 问 
题 进行 简要 介绍 。 进 一 步 详细 的 介绍 参见 本 书 的 第 
3、 第 4 章 和 第 19 章 。 


15.3.1 了 驱动 


电气 驱动 器 无 疑 是 机 器 人 手 驱动 的 最 普遍 的 选 
择 。 事 实 上 ， 电 动机 对 位 置 和 速度 的 控制 良好 ， 单 位 
功率 比较 合理 ， 并 且 无 须 添加 液压 或 气动 驱动 器 等 其 
他 驱动 器 所 需 的 附加 装置 。 当 然 也 存在 其 他 形式 的 驱 
动 器 ， 如 超声 驱动 器 ((Keio-P/57!). 、 化 学 驱动 器 、 
气动 驱动 器 (McKibben 用 于 Shadow F5?! ) , 9f 
驱动 器 (100G JIUBUULSS AS?) 等 。 

特别 地 ， 需 获取 快速 响应 时 ， 气 动 驱动 带 或 弹簧 
驱动 器 都 是 较 好 的 选择 ， 尽 管 这些 驱 动 器 必须 匹配 能 
够 快速 响应 的 制 动 系统 以 保证 较 好 的 位 置 控 制 。 


15.3.2 (ER 


在 机 器 人 手 或 其 他 机 器 人 机 构 中 ， 传 感 器 可 分 为 
两 大 类 : 内 部 传感器 和 外 部 传感器 。 前 者 测量 的 是 与 
装置 本 身 相 关 的 物理 状态 信息 ( 如 位 置 、 速 度 )， 而 
后 者 则 测量 物体 相关 的 反应 或 环境 变量 ( 如 外 力 / 力 
AB. HERE. JEJE), 

1. 关节 位 置 / 速 度 传感器 

为 实现 对 关节 的 控制 ,测量 被 驱动 关节 的 位 置 
与 速度 是 必要 的 ， 主 要 的 问题 在 于 传感器 及 导线 的 
可 用 空间 是 有 限 的 。 我 们 可 以 采用 不 同 的 技术 方案 ， 
但 比较 常规 的 选择 是 采用 霍 尔 效应 传感器 ， 这 种 传 


2. 妥 绳 张力 传感器 与 关节 力矩 传感器 

众所周知 ， 人 能 够 通过 控制 相关 肌肉 来 控制 手指 
的 动作 与 力度 。 在 远程 驱动 的 情况 下 ， 由 于 要 补偿 传 
动 系 统 中 的 摩擦 并 测量 外 部 作用 力 ， 测 量 腿 强 的 张力 
是 非常 有 必要 的 。 图 15.6 中 就 是 一 种 测量 腿 强 张力 
的 方式 ， 它 通过 压 在 腿 强 上 的 可 测量 应 变 的 柔性 板 实 
现 对 腿 绳 张力 的 测量 。 当 有 张力 作用 在 腿 强 上 时 ， 传 
感 器 测量 的 力 由 轴 向 分 量 和 切 向 分 量 合成 。 由 于 轴 向 
力 产生 的 位 移 相 对 于 切 向 力 产生 的 位 移 足 够 小 ， 故 可 
Uso b alice sei Rd 
时 附着 在 板 上 的 应 变 测量 仪 将 应 变 转 变 为 电信 号 。 现 
在 考虑 一 个 带 两 个 传感器 的 N 型 驱动 器 ， 如 图 15.7 
所 示 ， 其 中 关节 力矩 + 已 经 给 定 。 由 于 T= 
(T, -T,), EPT, T, T, 49 c SE ASAE c b tt 
的 紧 边 与 松 边 的 张力 。 而 有 FU T, 可 表示 为 e Ale, 
的 函数 ， 故 z 可 通过 将 e。 Ale, 代入 不 同 的 回路 来 获 
得 。 然 而 ， 这 种 方法 存在 很 多 问题 。 主 要 的 问题 是 
传感器 的 柔性 板 在 较 大 的 预 应 力作 用 下 会 产生 塑性 
变形 使 传感器 无 法 继续 工作 。 另 一 个 问题 是 测量 
个 关节 的 力矩 通常 需要 两 个 传感器 。 为 应 对 这 些 问 
题 ， 我 们 可 以 应 用 如 图 15. 8 所 示 的 张力 差 动 式 传 感 
器 5 于 21。 这 种 传感器 只 有 一 个 简单 机 体 ， 还 包含 一 
个 附 有 应 变 测 量 仪 的 弹性 部 分 。 图 15. 8a 反映 了 这 
种 传感器 的 工作 原理 。 力 矩 作 用 在 关节 上 时 ,7 、 
T, 的 值 不 同 ， 这 将 导致 应 变 测量 器 上 存在 切 向 力 。 
在 极 大 的 张力 作用 下 ， 切 向 分 力 会 像 没 加 力矩 时 一 
样 保 持 为 0。 这样， 预 应 力 造 成 的 弹性 板 塑 性 变形 
的 问题 就 不 存在 了 。 此 外 ， 这 类 传感器 的 构建 仅 需 
要 一 个 基 座 。 此 类 力 抢 传感器 存在 一 些 变 体 。 当 减 
小 图 15. 8a 中 滑轮 的 距离 ， 传 感 器 就 变 成 了 零 距 离 
的 单 滑轮 形式 ， 如 图 15. 8b 中 所 示 。 这 种 装置 已 应 
用 于 Darmstadt 手 55231 和 MEL 手 55 2 。 若 这 类 传 感 
器 通过 相应 的 妥 绳 连接 在 手指 连 杆 处 ， 则 传 感 涡 和 
用 强 之 间 没 有 相互 作用 ， 我 们 便 可 像 图 15. 8c 中 那 
样 移动 滑轮 。 这 种 结构 被 称 作 滑轮 缺失 模式 ， 已 经 
在 Hiroshima 手 上 得 以 应 用 。 对 于 测量 腿 绳 驱动 的 关 
节 ， 这 种 应 力 差 动 式 传感器 无 疑 是 一 种 强 有 力 的 


感 器 体积 足够 小 ， 测 量 结果 足够 精准 可 信 。 在 远程 
驱动 的 情况 下 ， 一 个 关节 可 以 用 到 两 个 位 置 / 速 度 传 


Rear: 一 个 在 驱动 器 上 (如 解码 器 )， 男 一 个 在 关 
节 本 身 。 这 通常 是 非常 有 必要 的 ， 因 为 传动 系统 中 
会 引入 一 些 非 线性 因素 (形变 ,摩擦 等 )。 通 常 上 
述 安装 在 关节 上 的 传感器 是 为 给 定 的 机 融 人 手 特别 
设计 的 ， 因 为 常用 的 传感器 体积 较 大 不 适合 安装 在 
XT, 


工具 。 


Æ 15.6 Weak fe oss 
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放大 器 


图 15.7 基于 腿 绳 的 力矩 传感器 


T Ti 


图 15.8 应 力 差 动 式 传感器 
a) 双 滑轮 模式 b) 单 滑轮 模式 c) 滑轮 缺乏 模式 


3. 指 尖 触 觉 (或 力 ) 传感器 

大 多 数 机 器 人 的 操纵 及 装配 中 都 会 用 到 触觉 传 感 
器 。 举 起 一 个 物体 时 ， 触 觉 传 感 吕 能够 及 时 侦 测 出 滑 
动 的 发 生 并 采取 有 效 措施 进行 阻止 。 除 了 指 尖 与 物体 
的 接触 点 之 外 ， 指 尖 触 觉 ( 或 力 ) 传感器 还 能 测定 
物体 的 一 些 性 质 ， 如 表面 的 摩擦 系数 、 表 面 质 地 及 重 
量 等 。 在 单一 接触 力作 用 下 ， 六 轴 的 力学 传感器 可 以 
测 出 手指 与 环境 指 尖 的 接触 点 以 及 相互 作用 力 的 大 
小 。 对 于 图 15.9 所 示 的 手指 结构 ， 力 的 大 小 与 传 感 
器 输出 关系 如 下 


F.=f (15.1) 

M, =x, xf (15.2) 

ste, feR^, F,eR^, M eR? Mx, e R^ 分 别 是 
六 轴 力 传感器 测 出 的 外 力 矢量 、 相 互 作用 力 矢量 、 力 
和 矩 矢 量 以 及 表征 接触 位 置 的 位 置 矢 量 。 由 式 
(15. 1) ， 我 们 可 以 直接 解 相 互 作 用 力 。 将 F, 代入 第 


图 15.9 传感器 坐标 系 


二 个 方程 可 解 得 满足 条 件 的 x,。 如 图 15. 10a 所 示 ， 
对 于 有 凸 面 的 物体 ， 一 般 可 以 得 到 两 个 解 ， 其 中 方程 
满足 f'n >0 的 解 是 有 意义 的 (手指 只 能 推 物体 )。 而 
对 于 凹面 物体 ， 我 们 至 少 可 以 得 到 4 个 解 ， 如 图 
15. 10b 所 示 ， 其 中 两 个 是 有 意义 的 。 如 图 15. 10e 所 
示 ， 位 于 指 尖 的 六 轴 力 传感器 很 好 的 避免 了 多 元 方程 
组 ， 同 时 只 有 指 尖 作 用 力 才 会 被 表征 。 因 此 ， 如 果 有 
多 个 连 杆 同时 与 物体 接触 ， 则 有 必要 在 每 根 连 杆 上 都 
加 一 个 力 / 力 矩 传 感 器 。 


六 轴 力 传感器 
c) 


Æl 15.10 解 的 说 明 
a) 凹面 物体 b) 上 四面 物体 c) 六 轴 力 传感器 


这 种 用 一 个 多 轴 传 感 器 同时 探测 力 和 力矩 大 小 以 
及 接触 点 位 置 的 方式 ， 被 称 作 内 部 触觉 (IT) 原 
理 '“”。 一般 来 说 ,与 下 文 所 述 的 传统 的 触觉 传 感 
器 相 比 ， 由 于 传 感 咒 上 的 电路 与 连接 较 少 ， 这 种 方式 
使 得 设计 更 为 简化 。 

4. 触觉 传感器 

还 有 一 类 很 重要 的 传 感 设备 由 触觉 传感器 组 成 ， 
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机 器 人 结构 


这 类 传感器 常用 于 测量 像 物体 形状 、 接 触 点 位 置 与 压 
力 等 目的 。 文 献 中 提出 过 很 多 触觉 传感器 ， 其 中 很 多 
原理 上 都 是 可 实现 的 : 光学 的 、 压 阻 的 、 压 电 的 等 。 
要 总 览 这 方面 的 技术 及 应 用 可 参阅 参考 文献 
[15.26] 和 [15.27]。 

触觉 传感器 开始 引入 机 器 人 是 在 20 世纪 70 年 
代 。 现 在 ， 与 力 传感器 一 样 ， 触 觉 传 感 器 也 已 得 到 很 
好 的 商业 化 应 用 。 可 以 说 ， 它 们 是 工业 传感器 应 用 的 
代表 ， 尽管 很 多 时 候 它 们 仅仅 作为 一 个 用 于 检测 一 次 
抓 取 或 者 接触 是 否 发 生 的 比较 高 级 的 设备 。 

通常 ， 触 觉 传感器 由 感性 元 件 的 矩阵 (数列) 
组 成 ， 每 个 传 感 元 件 都 被 看 作 一 个 触 元 (taxel， 由 触 
觉 元 件 而 来 )， 全 部 信息 被 称 作 是 触觉 图 像 〈( 见 图 
15. 11) 。 这 种 传感器 的 用 于 测量 面 上 的 应 力 分 布 。 


(ee) eX eXeXe eX) 
MDOQQOOOO 
DOQOQOOOO 
MDOQQOOO@O 
PDOQQOOOO 
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图 15. 11 触觉 传感器 
) 结构 b) 数据 


一 般 来 说 ， 通 过 触觉 传感器 能 获得 的 信息 有 : 

接触 : 这 是 这 类 传感器 能 获取 的 最 简单 信息 ， 即 
接触 有 没有 发 生 。 
力 : 每 个 传 感 元 件 都 可 给 出 局 部 所 加 的 力 的 相关 
信息 ， 可 以 以 多 种 方式 被 用 于 高 精度 的 连续 计算 。 
简单 的 几何 信息 : 接触 区 域 的 位 置 、 接 触 面 的 几 
何 形状 〈 平 面 ， 圆 面 等 ) 。 


物体 的 主要 几何 特性 : 通过 传感器 给 出 的 适当 精 
度 的 与 物体 三 维 形状 相关 的 数据 可 推断 出 物体 的 形 
状 ， 如 球体 或 圆柱 体 。 

机 械 特性 : 摩擦 系数 和 刚度 等 ， 也 可 以 测量 物体 
的 温度 特性 。 

滑动 状况 : 在 物体 与 传感器 之 间 的 有 关 运 动 。 

很 多 新 技术 已 被 用 于 设计 触觉 传感器 的 过 程 中 ， 
从 压 阻 式 到 电磁 式 再 到 光电 式 等 。 最 常用 到 的 触觉 传 
感 顺 工作 原理 主要 有 下 列 几 种 : 

半导体 式 、 电 磁感应 式 、 电 容 式 、 压 阻 式 、 光 电 
式 、 机 械 式 。 

上 面 的 每 种 技术 都 存在 各 自 的 优势 与 不 足 。 然 
而 ， 这 些 传感器 的 体积 一 般 相 对 于 可 用 空间 是 较 大 
的 ， 而 且 需 要 大 量 的 导线 连接 。 


15.4 机 器 人 手 的 建 模 与 控制 


内 置 驱动 式 机 器 人 手动 态 模 型 与 传统 形式 的 工业 
机 器 人 手 是 很 像 的 ， 也 能 够 进行 一 系列 的 操作 。 而 远 
程 驱动 方式 会 引入 一 些 值得 我 们 好 好 考虑 的 因素 。 特 
别 当 存在 一 些 非 线 性 因素 〈 如 摩擦 与 反 向 间隙) 时 ， 
传输 系统 的 稳定 性 、 非 固定 连接 的 传感器 及 驱动 器 都 
将 成 为 机 器 人 控制 系统 设计 的 重 中 之 重 。 此 外 ， 单 向 
驱动器， 如 腿 强 驱动 系统 ， 需 要 合适 的 控制 技术 保证 
各 个 关节 的 设 定 力矩 在 相互 耦合 后 还 可 以 有 一 定 的 附 
加 效果 。 


15.4.1 柔性 传动 系统 的 动态 效应 


远程 驱动 式 机 器 人 手 的 传动 系统 往往 存在 很 大 的 
摩擦 ， 同 时， 不 可 忽视 的 动态 效应 更 增加 了 问题 的 复 
杂 性 。 一 个 简单 的 表现 就 是 由 弹性 传动 元 件 连 接 的 两 
个 惯性 元 件 的 单 轴 移 动 。 这 是 弹性 关节 的 典型 表现 形 
式 ， 前 一 个 元 件 表征 电动 机 的 惯性 ， 而 后 一 个 与 驱动 
关节 / 连 杆 的 惯性 相关 ， 如 图 15.12 所 示 。 复 杂 的 情 
况 ， 考 虑 传动 系统 的 动态 模型 ， 即 将 腿 绳 经 典 表示 为 
一 系列 由 弹簧 /阻尼 器 连接 的 质量 ， 如 图 15. 12b 所 
示 。 由 于 驱动 系统 和 驱动 元 件 处 在 不 同位 置 ， 且 运动 
是 通过 一 个 不 理想 (不 绝对 静止 元 件 传 输 的 ， 这 
种 简单 的 模型 对 于 理解 这 些 因素 造成 的 缺点 和 局 限 是 
很 有 帮助 的 。 当 我 们 考虑 手指 关节 承受 外 力 的 能 
时 ， 图 15. 12a 中 所 示 的 传动 系统 所 模拟 的 开 环 系统 
会 有 明显 的 带宽 减 小 和 输入 F, 〈 电 动机 作用 力 ) 与 
输出 (接触 引起 的 力 的 改变 ) 的 延 时 ， 如 15.13 
所 示 ， 开 环 传递 函数 
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驱动 器 传动 


手指 环境 力 传感器 


图 15. 12 弹性 关节 的 典型 表现 形式 
a) 带 有 弹性 传动 的 机 器 人 关节 模型 b) ET EA Feat n OS 


fir (bas +k.) (bs +, ) 
F, (js? +(b, +b, )s +h, +k, | Qus) bs) - (bs +h)? 
(15.3) 
有 四 个 极点 ， 增 加 传动 刚度 的 值 ， 各 极点 将 在 绝 
对 刚性 (k 趋 于 无 穷 ， 两 个 极点 趋 于 无 穷 远 点 ) 的 
传动 和 电动 机 与 连 杆 的 惯性 作用 下 ， 从 初始 位 置 
(由 物理 量 j 、j, 等 参数 决定 ; 当 =0 时 ， 至 少 有 
一 个 极点 处 于 高 斯 平面 原点 的 位 置 ) 向 系统 的 两 极 
移动 。 此 时 的 传递 函数 为 
F, (b.s +k.) 
Fo” Gi +j)? tbs +k, 


(15.4) 


abot V be - Am fi) ke 
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Æ 15.13 PRE k 的 传递 函数 (15.3) 的 根 轨迹 图 


结果 是 ， 当 系统 的 柔性 不 可 忽略 时 ， 和 柔性 传动 系 
统 的 带宽 将 会 减 小 ， 如 图 15. 14 中 波 特 图 所 示 。 和 柔性 
传动 系统 的 带宽 受 减速 右 位 置 的 影响 很 大 ， 当 减速 器 
安装 在 关节 处 ,带宽 会 是 减速 器 直接 安装 在 电动 
HLS ERTAS K, fi (如 图 15.15 所 示 ，K, 是 减速 


比 ) 。 更 有 意义 的 情况 是 ， 在 刚度 K, 较 小 的 情况 下 ， 
弹性 模式 下 系统 的 频率 会 有 一 个 又 降 ， 因 此 ， 电 动机 
上 施加 的 力 频率 值 会 较 低 ， 并 且 通 过 关节 上 传感器 的 
测量 所 得 的 量 是 完全 反 相 的 。 这 些 会 使 整个 系统 在 力 
控制 下 〈 或 者 说 阻抗 控制 ) 的 不 稳定 效果 被 称 为 不 
匹配 性 。 一 般 来 说 ， 驱 动 器 和 传 感 右 安装 在 弹性 结构 
(或 带 有 柔性 传动 的 结构 ) 的 不 同 点 时 ,闭环 系统 会 
不 稳定 SI 


幅 值 /dB 
20 


------ 高 刚度 传动 
一 一 低 刚度 传动 ^ 
niens 不 传输 js 
10! 102 10? 10% 
频率 /(rad/s) 


图 15.14 开 环 传递 函数 (15.3 ) 的 波 特 图 


从 机 器 人 控制 上 来 看 ， 由 机 械 传 动 的 柔性 对 于 了 驱 
动 带 和 运动 传递 的 影响 要 远 远 超过 非 线 性 摩擦 现象 。 
EXE, ÆR 15.12 中 ， 由 阻尼 系数 b, 表征 的 线性 黏 性 


n 


{lin 
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图 15.15 DLR- I 手中 间 指 关节 上 
减速 器 的 位 置 


摩擦 力 ， 伴 随 着 静摩擦 和 库仑 摩擦 ， 两 者 在 速度 为 零 
的 情况 下 都 是 不 连续 的 ， 如 图 15. 16 所 示 。 这 些 非 线 
性 因素 会 产生 极限 环 和 输入 依赖 型 稳定 性 。 因 此 在 设 
计 机 械 人 手 和 它 的 控制 结构 的 时 候 ， 这 些 因素 必须 仔 
4p ES) AAE Utah/MIT 手 的 设计 中 (如 图 
15.17 所 示 ) ， 为 减 小 静摩擦 ,设计 者 用 滑轮 组 取代 
了 腿 强 套 '” 站 。 为 了 得 到 机 械 布局 的 复杂 性 、 可 靠 性 
以 及 良好 的 摩擦 水 平 最 优化 的 折 中 解 ， 设 计 者 们 采用 
了 一 系列 的 方法 将 腿 绳 套 与 滑轮 组 结合 起 来 共同 用 


b) 


图 15. 16 摩擦 现象 
a) 茸 性 摩擦 b) 静摩擦 或 库仑 摩擦 


图 15.17 Utah/MIT 机 器 人 手 


将 腿 强 由 驱动 器 引 至 手指 关节 处 ， 例 如 图 15. 18 中 所 
示 的 Stanford 手 和 UB-3 手 。UB 手 结 构 极 其 简单 ， 其 


REA SE TEA PPA, MARAH, E 
擦 不 能 被 绝对 忽略 
模型 。 


需要 妥 强 与 管 壁 相互 作用 的 精确 


图 15.18 a) Stanford/JJPL# b) UB-3 手 


15.4.2 ” 套 管 妥 强 系统 的 传动 模型 


这 种 系统 的 模型 如 图 15.19 所 示 ， 其 中 了 ,， 
Tons To, €, Eons Ri, x, L 2320 29 8 A Pri AT t Py 
张力 ， 初 始 张力 ， 输 入 端 和 输出 端 应 变 ， 管 路 半径 
沿 ， 导 线 方向 的 坐标 和 腿 绳 长度。 输出 端 张力 与 输入 
端 位 移 关系 为 ”1 

Pou - Tin =K (Ein Pp ) (15.5) 
sp, K 与 $s 分 别 为 总 刚度 和 反作用 力 ， 由 下 列 一 
组 公式 求 出 


1 1 1 
K K K'K. (15.6) 
À 
KK (15.7) 
TL e -A-1 
b= (15.8) 
A - X |B; | usené,, (15.9) 


sth, Ko K, K,, Kps u, E, A, B, 分 别 为 环境 刚 
HE. FG RRS HE, MEZA SE, ERRA, WW 
氏 模 量 BEART AR AEE HEE, FAL 15. 19 所 
AWLP YD |B, | =2w。 可 以 看 出 ， 当 管 路 严重 弯曲 
时 ， 与 摩 控 有关 的 参数 和 急剧 增加 。 

尽管 选用 自由 路 径 传递 功率 具有 很 大 的 优势 ， 这 
也 会 导致 传动 系统 具有 很 大 程度 的 非 线 性 。 值 得 注意 
的 是 ， 虽 然 妥 绳 的 等 效 刚度 和 反作用 力 均 随 曲 率 函 数 
A 及 摩擦 因数 的 变化 而 变化 ， 当 j=0 时 ，d = 0， 
K,, = 天,。 从 控制 的 角度 上 看 ， 这 样 的 滞后 现象 显然 
不 是 我 们 希望 看 到 的 结果 。 为 应 对 这 样 的 问题 ， 腿 强 
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Æ 15.19 £f NAE 


应 当 被 设计 成 尽 可 能 的 短 ， 这 样 我 们 就 可 以 在 传动 系 
统 中 保持 较 高 的 刚度 和 较 小 的 回程 间 际 。 


15.4.3 ”通过 单 向 驱动 器 的 控制 


单 向 驱动 器 (即使 用 妥 强 传动 的 标准 电动 机 ) 
应 用 于 远程 驱动 装置 中 ， 这 类 驱动 器 的 使 用 需要 采取 
特殊 的 控制 技术 以 保证 关节 上 所 受 的 力矩 并 保持 胁 强 
的 正 压 力 。 为 了 这 个 目的 ， 妥 绳 被 看 做 无 弹性 无 阻尼 
元 件 ， 问 题 也 被 认为 与 之 前 讨论 过 的 系统 的 稳定 性 完 
全 无 关 。 

通过 腿 强 或 滑轮 分 布 在 手指 结构 中 的 腿 强 可 以 通 
过 将 关节 形态 与 妥 绳 延伸 率 联系 起 来 的 延展 函数 L 


(0) 5? 35k, MET Fl 15.2 PERRA, =% 
强 的 延展 函数 为 

1.(0) =l; + RO, + RO, 
式 中 ,RR 为 滑轮 盘 半 径 ,，09 =[9， 06,]' 为 关节 变量 


量 。 一 旦 延展 函数 确定 ， 腿 强力 与 关节 转 矩 的 关系 就 


很 容易 确定 。 事实 上 ， 关 节 转 速 9 与 腿 强 速度 1 可 
用 延展 方程 的 微分 表示 


. ol . = 
1 =35(0)0 =P(0)0 (15. 10) 

为 避免 功率 损失 ， 由 式 (15.10) 可 得 
T=P"(0)f (15.11) 


AP, 7 为 施加 在 关节 处 的 力矩 , f AREH. 
式 (15.11) 表明 一 条 腾 绳 传递 的 力 将 作用 于 不 止 一 
个 关节 。 

为 保证 在 纯 拉 力 的 约束 下 在 各 方向 上 对 关节 施加 
力矩 ， 对 于 任意 的 Te R"， 存 在 一 系列 的 力 f. eR" 
使 得 


T-P'(Of Bf.>0,i=1,2,.…,m (15.12) 
AH, n5 m aH SRA, ND, pE 
网 络 被 称 为 力 封闭 。 如 果 式 (15.12) Mr, AeA 
和 矩 向 量 时 驱动 器 必须 向 腿 强 提供 的 力 的 大 小 可 由 如 下 


公式 计算 出 

f-P(08)T«f, (15.13) 
X, P'eP(P'-P) HIRA SEE Pg 
阵 ; fe Ic (PT). Bp UU MES TER JS E B5 PI 73 F8] 
tt, e, AHMAT REB 7) VE TS RR A8 SR Pk E 
GAB MAS EF Ji Jt 


15.4.4 机 器 人 手 的 控制 


之 前 章节 中 讨论 的 模型 与 控制 方面 的 问题 非常 
重要 也 非常 基础 ， 但 在 机 器 人 手 控制 上 这 些 都 是 较 
低层 次 上 的 问题 ， 因 为 它们 都 与 设备 自身 的 特性 
相关 。 

要 想 以 正确 的 方式 操作 多 指 机 器 人 手 ， 必 须 去 
面 对 并 解决 另外 一 些 问题 。 为 解决 这 些 问 题 ， 需 设 
计 机 器 人 手 的 高 级 控制 方式 ， 这 必须 考虑 到 手 与 物 
体 及 环境 的 相互 作用 。 在 这 种 背景 下 ， 必 须 考虑 的 
方面 有 : 施加 在 关节 处 的 力 与 力矩 的 控制 ， 对 屈服 
及 摩擦 建 模 的 必要 性 ,手指 及 接触 点 的 运动 形式 
(滚动 ， 滑 动 等 ) ， 抓 取 并 (或) 熟练 操作 物体 的 程 
序 算法 等 。 这 些 问 题 将 在 第 26 章 、 第 27 章 和 第 28 
章 详细 阐明 。 


15.5 应 用 与 发 展 趋势 


[ 业 环 境 下 ， 简 单 化 与 低 成 本 是 设计 执行 器 的 
准则 ， 因 此 ， 诸 如 开 闭 夹 持 器 之 类 的 简单 设备 应 用 
非常 普遍 。 这 种 情况 使 得 多 年 来 一 些 专用 设备 已 经 
发 展 为 只 能 执行 单一 的 特定 操作 而 不 适用 于 其 他 任 
务 。 此 时 ， 灵 巧 型 多 指 机 器 人 手 由 于 其 可 靠 性 、 复 
杂 性 和 成 本 等 问题 尚未 被 应 用 与 任何 主要 的 生产 
领域 。 

另 一 方面 ， 如 今 越 来 越 多 的 操作 被 设计 成 由 人 类 
操控 的 机 器 人 在 特定 的 工作 环境 下 工作 。 娱 乐 、 维 
修 、 空 间 探 测 、 帮 助残 疾 人 都 是 机 器 人 系统 应 用 的 典 
型 例子 ， 这 些 例子 中 ， 机 器 人 需要 操作 为 人 设计 的 工 
有 具 或 物体 (或 者 人 类 自身 ) 。 这 种 情况 下 ， 机 器 人 必 
须 能 抓 取 并 熟练 操作 尺寸、 形状 、 质 量 等 不 同 的 物 
体 ， 因 此 ， 具 有 合适 数目 手指 及 高 度 拟人 化 外 表 的 机 
器 人 手 是 最 佳 的 选择 。 

此 时 ， 一 系列 致力 于 研发 高 度 拟 人 化 机 器 人 的 工 
程 已 经 相继 启动 。 其 中 较为 著名 的 有 NASA/JPL 的 
Robonaut ^7 (Wf 15.20), DLR 的 设备 以 及 许多 
正在 开发 的 拟人 机 器 人 。 
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15.4 J. Butterfass, G. Hirzinger, S. Knoch, H. Liu: DLR's 
^ RE multisensory articulated hand. Part I: Hard- and 
15. 6 结论 与 扩展 阅读 software architecture, Proc. IEEE Int. Conf. Robot. 
Autom. ICRA99 (1999) 
自从 机 器 人 技术 发 展 早期 开始 ， 多 指 机 器 人 手 的 15.5 C. Melchiorri, G. Vassura: Mechanical and control 
-" : 、 x A u ers features of the university of Bologna hand version 
设计 便 吸 引 了 许多 研究 机 构 的 兴趣 ， 不 只 是 由 于 技术 2, Proc. IEEE/RSJ Int. Conf. Int. Robot. Syst. IROS'92 
性 的 挑战 本 身 ， 更 在 于 拟人 化 的 诱惑 以 及 对 人 类 自身 
ices a ret " 15.6 W.T. Townsend: MCB - industrial robot feature 
身体 知识 的 渴求 。 近 10 年 来 ,许多 重要 的 工程 业已 article- Barrett hand grasper, Ind. Robot. 27(3), 
开展 ， 一 些 典 型 的 机 器 人 手 范例 已 经 问世 。 然 而 目 181-188 (2000) 

E Ja qe = : 15.7 JH. Kawasaki, T. Komatsu, K. Uchiyama: Dexter- 
靠 的 柔性 的 ; 法 在 实际 多 - dudo DUE 
前 ， 可 靠 的 柔性 的 灵巧 手 依然 无 法 在 实际 领域 中 得 以 ous anthropomophic robot hand with distributed 
应 用 。 由 于 这 些 原 因 ， 很 容易 设想 ， 随 着 技术 ( 传 tactile sensor: Gifu hand Il, IEEE/ASME Trans. 

e T hy Su Mechatron. 7(3), 296-303 (2002) 
Jai n E: Vz. yk MS vs 后 | ga D 
iiid DLE HAS) TR BTR C, 编 15.8 TJ. Doll, H.J. Scneebeli: The Karlsruhe hand, 
程 等 ) 水 平 的 不 断 发 展 ， 机 器 人 手 领 域 始终 将 存在 Preprint IFAC Symp. Robot Contr. SYROCO (1988) 
量 的 研究 活动 。 手 与 其 他 科技 领 亏 I pp. 1-6 
si o Epi ae 他 科技 领域 (如 认 15.9 N. Fukaya, S. Toyama, T. Asfour, R. Dillmann: De- 
知 科学 ) 的 结合 也 是 值得 期 待 的 。 sign of the TUAT/Karlsruhe humanoid Hand, Intell. 
由 于 此 研究 十 分 广泛 ， 很 难 再 给 读者 推荐 更 深入 Robot. Syst. 3, 1754-1759 (2000) 
TENEI? E ES 15.10 A. Bicchi, A. Marigo: Dexterous grippers: putting 
h SE AS e e p - y € "n " 
的 阅读 资料 ， 除 了 参考 文献 [15. 32-34] 所 列 的 专 nonholonomy to work for fine manipulation, Int. 
业 书 籍 。 事 实 上， 在 专业 研究 领域 ， 科 技 期 刊 及 会 议 J. Robot. Res. 21(5-6), 427-442 (2002) 
— PNEU MSS - 15.11 M.C. Carrozza, C. Suppo, F. Sebastiani, B. Massa, 
《 43 A jag E 4 从 每 
文献 中 的 技术 论文 等 资料 也 是 可 用 的 。 而 且 ， odd F. Vecchi, R. Lazzarini, M.R. Cutkosky, P. Dario: 
年 都 有 数 百 篇 涵盖 机 器 人 领域 各 个 方面 的 论文 出 版 ， The SPRING hand: development of a self-adaptive 
给 出 特别 的 推荐 阅读 材料 很 困难 。 因 > 人 prosthesis for restoring natural grasping, Auton. 
给 出 特别 的 荐 阅读 材料 很 fe, PAG, FRAT ea DE 
家 推荐 章 后 的 参考 书目 。 15.12 J.L. Pons, E. Rocon, R. Ceres, D. Reynaerts, B. Saro, 
S. Levin, W. Van Moorleghem: The MANUS-hand 
X " dextrous robotics upper limb prosthesis: mechani- 
参 考 x 献 cal and manipulation aspects, Auton. Robots 16(2), 
153-163 (2004) 
JARA : TN 15.13 T. Iberall, C.L. MacKenzie: Opposition space and 
15.1 T. Okada: Object-handling system for manual in human prehension. In: Dextrous Robot Hands, ed. 
dustry, IEEE Trans. Syst. Man Cybern. 2, 79-86 b T. Iberall. S.T. Venkat (Spri New York 
(1979) a erall, S.T. Venkataraman (Springer, New Yor 
15.2 K.S. pe a ee 2 iis puo 15.14 A. Bicchi: Hands for dexterous manipulation and 
yale Or -alelcurated Mechanical Mandy el een an robust grasping: a difficult road toward simplicity, 
Trans. Actuat. Des. 105, 35-41 (1983) IEEE T Robot. Autom. 16(6), 652-662 (2000) 
15.3 S.C. Jacobsen, E.K. Lversen, D.F. Knutti, R.T. Lohn- rans. Robot: Autom: Tet5), 85 
15.15 M.R. Cutkosky: On grasp choice, grasp models, and 


san, K.B. Biggers: Design of the Utah/MIT dexterous 
hand, Proc. IEEE Int. Conf. Robot. Autom. ICRA86 
(1986) 


the design of hands for manufacturing tasks, IEEE 
Trans. Robot. Autom. 5(3), 269-279 (1989) 


9815 :8 机 器 人 手 


285 


15.16 


15.17 


15.18 


15.19 


15.20 


15.21 


15.22 


15.23 


15.24 


J. Butterfass, M. Grebenstein, H. Liu, G. Hirzinger: 
DLR-hand ii: next generation of a dextrous robot 
hand, Proc. IEEE Int. Conf. Robot. Autom. ICRAO1 
(Seoul 2001) 

C. Melchiorri, G. Vassura: Mechanical and control 
features of the UB hand version II, Proc. IEEE/RSJ 
Int. Conf. Int. Robot. Syst. IROS'92 (1992) 

R.O. Ambrose, H. Aldridge, R.S. Askew, R.R. Bur- 
ridge, W. Bluethmann, M. Diftler, C. Lovchik, 
D. Magruder, F. Rehnmark: Robonaut: NASA's space 
humanoid, IEEE Int. Syst. (2000) 

L. Birglen, C.M. Gosselin: Kinetostatic analysis of 
underactuated fingers, IEEE Trans. Robot. Autom. 
20(2), 211 (2004) 

|. Yamano, T. Maeno: Five-fingered robot hand us- 
ing ultrasonic motors and elastic elements, Proc. 
IEEE Int. Conf. Robot. Autom. (2005) pp. 2684-2689 
Shadow Dexterous Hand, (Shadow Robot Ltd., Lon- 
don 2007) http://www.shadow.org.uk/ 

M. Kaneko, M. Higashimori, R. Takenaka, 
A. Namiki, M. Ishikawa: The 100G capturing robot 
-too fast to see, Proc. 8th Int. Symp. Artif. Life 
Robot. (2003) pp.291-296 

W. Paetsch, M. Kaneko: A three fingered multi- 
jointed gripper for experimental use, Proc. IEEE Int. 
Workshop Int. Robot. Syst. IROS'90 (1990) pp. 853- 
858 

H. Maekawa, K. Yokoi, K. Tanie, M. Kaneko, 
N. Kimura, N. Imamura: Development of a 
three-fingerd robot hand with stiffness con- 
trol capability, Mechatronics 2(5), 483-494 


15.25 


15.26 


15.27 


15.28 


15.29 


15.30 


15.31 


15.32 


15.33 


15.34 


(1992) 

A. Bicchi: A Criterion for optimal design of multiaxis 
force sensors, J. Robot. Auton. Syst. 10(4), 269-286 
(1992) 

A. Pugh: Robot Sensors: Tactile and Non-Vision, 
Vol.2 (Springer, Berlin, Heidelberg 1986) 

H.R. Nicholls, M.H. Lee: A survey of robot tactile 
sensing technology, Int. J. Robot. Res., 8(3), 3-30 
(1989) 

W.T. Townsend, J.K. Salisbury: Mechanical band- 
width as a guideline to high-performance manip- 
ulator design, Proc. IEEE Int. Conf. Robot. Autom. 
ICRA89 (1989) 

S.D. Eppinger, W.P. Seering: Three dynamic prob- 
lems in robot force control, IEEE Trans. Robot. 
Autom. 8(6), 751-758 (1992) 

W.T. Townsend, J.K. Salisbury: The effect of 
coulomb friction and stiction on force control, Proc. 
IEEE Int. Conf. Robot. Autom. ICRA87 (1987) 

M. Kaneko, T. Yamashita, K. Tanie: Basic consid- 
erations on transmission characteristics for tendon 
drive robots, Proc. 5th Int. Conf. Adv. Robot. (1991), 
827-832 

R.M. Murray, Z. Li, S.S. Sastry: A Mathematical 
Introduction to Robotic Manipulation (CRC, Boca 
Raton 1994) 

J. Mason, J.K. Salisbury: Robot Hands and the 
Mechanics of Manipulation (MIT Press, Cambridge 
1985) 

M.R. Cutkosky: Robotic Grasping and Fine Manip- 
ulation (Springer, New York 1985) 


第 16 JH plas A 


Shuuji Kajita, Bernard Espiau 


赵 明 国 i 

未 章 我 们 介绍 有 腿 机 器 人 ，16.1 节 介 绍 有 腿 16. 3.2 sien KOREA Danae Rada ri ARA ER ERN E gods 290 
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(ZMP) 是 控制 双 足 机 器 人 的 一 种 实用 方法 ,我们 164.4 ABT ZMP BOTT AEE ASAE Be eene 297 
会 在 16.4 节 中 讨论 它 的 定义 、 物 理 含义 、 测 量 、 TSAO SEAM NESE Pega cnp 2 
计算 与 应 用 。 在 16.5 节 我 们 将 话题 转移 到 多 腿 机 164.6 ZMP 概念 的 拓展 pp 299 
器 人 。 步 态 和 稳定 性 之 间 的 关系 是 这 一 领域 最 重要 16.5 多 腿 机 器 人 299 
的 主题 。 我 们 还 会 介绍 一 些 在 该 领域 有 重要 影响 的 16.5.1 BASE A e oir alert s 299 
机 器 人 。16. 6 节 概 括 地 介绍 了 有 腿 机 器 人 的 分 类 。 155.2 实用 的 步 态 设 计 
可 以 看 到 腿 - 轮 混合 机 器 人 、 腿 - 璧 混合 机 器 人 、 强 16. 5.3” 受 哺乳 动物 启发 的 动态 四 足 机 器 人 … 303 
索 行走 机 器 人 和 胞 壁 机 器 人 。 为 了 比较 这 些 具有 不 16.5.4 基于 行为 的 多 腿 机 器 人 和 303 
同 结构 的 有 腿 机 器 人 ， 我 们 在 16.7 节 中 介绍 了 一 16.6 其 他 的 有 腿 机 器 人 EE dodo EET 304 
些 实用 的 性 能 指标 ， 例 如 弗 劳 德 数 和 阻力 系数 。 I De ud SRM de 
16.8 WARRE TRA TANE 1662 a oe i 

. 6. 绳索 行走 机 器 人 
Pus 16.6.4 JQBEBLAR A e MMMHMMMMIMMIRR 305 
16.7 ”人 性 能 指标 MH 305 
16.1 JJ AIR n M HMM 286 16.7 1 稳定 裕 度 概念 的 拓展 ene 305 
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16.3.1 WdjgNHizxB]ee MM 290 


设计 和 实现 人 造 机 器 的 想法 几乎 和 人 类 的 历史 一 样 
和 久远。 在 Leonardo Da Vinci 的 一 些 奇 妙 却 徒 有 其 表 的 研 
究 之 后 ， 出 现 了 被 称 作 自动 机 的 第 一 代 人 造 机 器 ， 它 们 
主要 由 Jacquard, Jacquet- Droz, Vaucanson 等 于 18 世纪 
前 后 在 法 国 制作 完成 (包括 著名 的 自动 鸭子 )。 随 后 ， 
从 1850 年 到 第 一 次 世界 大 战 之 间 人 们 实现 了 一 系列 的 E 
动机 械 装置 。 这 一 领域 经 历 了 一 段 漫长 的 萧条 岁月 ， 直 
到 20 世纪 70 年 代 初 才 得 以 复苏 。 值 得 一 提 的 是 ， 它 的 
复苏 是 由 科学 家 们 所 推动 ， 而 不 像 前 些 世 纪 那 样 ， 由 天 


才 的 工程 师 、 艺 术 家 和 魔术 师 们 来 完成 。 


16.1 历史 概述 


有 腿 机 器 人 领域 的 开创 性 工作 始 于 1970 年 前 后 ， 
由 两 位 著名 的 研究 人 员 Kato 和 Vukobratovie 完成 。 他 
们 工作 的 共同 特色 是 设计 了 相关 的 实验 系统 。 在 日 
本 ，Kato 和 他 的 小 组 于 1973 年 在 早稻 田 大 学 展示 了 
第 一 台 仿 人 机 器 人 WABOT 1 号 。 它 采用 了 一 种 非常 


9816 章 ”有 了 腿 机 器 人 287 


简单 的 控制 策略 ， 以 静态 平衡 的 方式 实现 了 几 步 缓慢 
的 行走 。 这 一 成 就 是 日 本 有 腿 机 器 人 辉 煌 时 代 的 
开端 。 

与 此 同时 ，M. Vukobratovic 和 他 的 研究 小 组 正 
在 研究 功能 康复 中 的 一 些 问题 。 在 斯 洛 文 尼 亚 贝 尔 
格 莱 德 的 米 哈 伊 洛 普 平 学 院 ， 他 们 设计 出 了 世界 上 
第 一 台 主 动 式 外 骨髓 和 一 些 其 他 设备 ， 如 贝尔 格 莱 
德 手 。 但 他 们 最 著名 的 成 果 却 是 关于 运动 稳定 性 的 
分 析 ， 即 于 1970 年 前 后 所 提出 的 零 力矩 点 (ZMP) 
的 概念 ， 这 个 概念 从 那 时 起 就 被 广泛 地 采用 ”1 。 
零 力 矩 点 首次 形式 化 地 提出 了 有 腿 机 器 人 对 动态 稳 
定性 的 要 求 ; 它 的 思想 是 用 动态 转 矩 来 扩展 传统 的 
静态 平衡 准则 (质心 投影 必须 处 于 接触 点 所 形成 的 
凸 多 边 形 内 部 ) 。 这 一 重要 内 容 ， 将 在 本 章 中 进行 
详细 的 论述 。 

在 接 下 来 的 十 年 里 ， 突 破 性 的 进展 来 自 美 国 。 
R. McGhee 于 20 世纪 60 年 代 在 USC. ( 南 加 州 大 学 ) 
和 70 FERRE OSU (RA HIN AA) 的 早期 研究 
工作 ， 使 得 第 一 台 计算 机 控制 的 行走 机 器 人 面世 。 
M. Raibert 开始 在 卡 内 基 梅 隆 大 学 研究 动态 稳定 的 跑 
步 机 器 人 ， 后 来 他 在 麻 省 理工 学 院 建立 了 腿 实验 室 。 
在 这 个 实验 室 他 设计 了 一 系列 主动 的 跳跃 机 器 人 ， 
包括 一 条 腿 、 两 条 腿 和 四 条 腿 机 器 人 。 在 所 取得 的 
显著 成 果 中 ， 最 著名 的 是 一 个 两 腿 跳 跃 机 器 实现 了 
空翻 动作 。 同 时 ，R. McGhee fll K. Waldron 在 制造 了 
一 些 原 型 样机 之 后 ， 成 功 地 设计 出 了 世界 上 最 大 的 
六 足 机 器 人 。 这 个 被 叫做 自 适 应 悬 架 车 的 家 伙 ， 实 
际 上 是 一 个 由 人 控制 的 可 以 在 自然 的 无 规则 地 型 上 
行走 的 准 工 业 系统 ( 见 16.5.2 7). 

有 腿 机 器 人 研究 的 第 三 个 重要 时 期 是 20 世纪 90 
年 代 早期 。 毫 无 疑问 ， 研 究 纯 被 动机 械 系统 的 想法 由 
McGeer FPS McGeer 在 他 的 论文 中 介绍 了 自然 
的 周期 性 运动 的 概念 。 对 于 一 类 非常 简单 的 系统 : 倾 
斜 平面 上 的 一 个 圆规 模型 ， 其 稳定 的 行走 来 自 斜 坡 下 
降 所 增加 的 能 量 和 碰撞 损失 的 能 量 之 间 的 平衡 。 本 文 
特别 强调 ，McGeer 在 机 器 人 人 研究 者 中 普及 了 用 庞 加 
莱 映 射 分 析 这 类 系统 轨道 稳定 性 的 方法 。 一 些 研究 者 
沿 着 McGeer 开创 的 道路 继续 前 进 ， 进 行 了 许多 拓展 
( 见 图 16.1) : 3E TARP. BRUM UU, EE 
动 控制 和 类 似 机 器 人 Rabbit 一 样 能 行走 /跑步 的 全 驱 
DESC E, 

新 千年 结束 前 是 一 个 技术 活动 频繁 的 时 期 。 工 
业 上 的 突破 性 进展 向 世界 展示 了 现在 已 能 够 制造 出 
真正 的 仿 人 机 器 人 。 在 日 本 ，Honda (AH) 公司 


图 16.1 有 驱动 的 双 足 机 器 人 [81 2] 


a) Denise(2004) b) Rabbit(2003) 


T 1996 年 展示 了 第 一 个 仿 人 机 器 人 P2， 紧 跟 其 后 
诞生 了 很 多 仿 人 机 器 人 。 现 在 ， 最 激动 人 心 的 技术 
成 果 还 是 由 工业 界 实现 的 : ASIMO (Honda), QRIO 
(Sony), HRP (Kawada) 是 当今 众多 仿 人 机 器 人 中 
的 代表 。 同 时 ， 应 该 注意 到 主要 面向 娱乐 的 小 型 仿 
人 机 器 人 的 市 场 ， 在 过 去 的 十 年 里 一 直 在 稳定 地 
增长 。 

当 我 们 审视 过 往 的 历史 和 当前 的 现状 时 ， 会 很 明 
显 地 感到 机 器 人 科学 家 们 正面 临 着 一 个 挑战 。 优 秀 的 
技术 成 果 已 经 实现 了 ， 特 别 是 双 足 机 器 人 。 但 是 ， 这 
些 系 统 真 正 自主 地 在 不 平整 和 多 样 的 地 面 上 行走 的 能 
力 还 有 待 验证 ， 特 别 是 在 人 类 的 日 常生 活 环境 里 。 因 
此 ， 本 章 的 目的 是 在 建 模 与 控制 的 最 新 进展 方面 介绍 
一 些 要 点 ， 以 便 在 需要 时 可 以 设计 出 充足 且 有 效 的 控 
制 算 法 。 我 们 以 两 类 主要 的 方法 为 基础 : 一 种 方法 采 
用 所 谓 的 正 动力 学 ， 另 一 种 采用 ZMP (EJEA) 
本 章 的 结构 如 下 : 在 简短 地 概述 了 用 于 跳跃 和 被 动机 
器 人 的 控制 原理 之 后 ， 我 们 会 聚焦 于 基于 动力 学 模型 
的 双 足 机 器 人 的 控制 问题 : 建 模 、 稳 定性 、 轨 迹 生 成 
与 控制 。 然 后 我 们 会 深入 阐述 ZMP (FHEA) 的 
概念 以 及 它 在 控制 算法 中 的 应 用 。 因 为 前 几 部 分 主要 
涉及 双 足 机 器 人 ， 这 一 章 以 专门 介绍 多 腿 机 器 人 的 小 
节 作 为 结尾 。 
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机 器 人 结构 


16.2 周期 性 行走 的 分 析 


16.2.1 有 关 跳 跃 机 器 人 的 几 点 


周期 性 有 腿 机 器 人 是 指 那些 自然 地 或 者 在 控制 的 
作用 下 可 以 进入 一 个 稳定 行为 状态 的 系统 ， 其 特征 是 
在 相 平面 上 具有 一 个 封闭 的 环 。 隐 含 的 假设 是 这 种 系 
统 在 某 种 意义 上 或 多 或 少 地 隐 含 着 一 些 优化 的 自然 行 
为 。 在 此 类 机 器 人 中 ， 跳 跃 机 器 人 是 非常 吸引 人 的 ， 
因为 它们 通常 是 不 稳定 的 ， 但 就 速度 而 言 却 具 有 很 高 
的 性 能 。 

如 前 所 述 ， 麻 省 理工 学 院 的 腿 实验 室 已 经 对 这 些 
机 器 进行 了 深入 研究 。 这 一 章 的 目的 并 不 是 要 深入 地 
阐述 相关 的 设计 方法 和 控制 技术 。 关 于 这 一 方向 ， 我 
们 向 读者 推荐 一 本 Mark Raibert 所 著 的 很 出 色 但 已 很 
古老 的 书 " 5 。 这 里 我 们 仅 参 考 该 书 对 Raibert 的 成 
果 作 简短 的 介绍 。 

实际 上 ， 他 的 工作 始 于 平面 的 单 腿 跳 跃 机 器 人 。 
Raibert 说 明了 这 种 系统 的 控制 可 以 分 解 为 三 个 独立 
的 部 分 : 第 一 部 分 是 在 每 一 个 周期 内 提供 一 个 固定 的 
推力 来 控制 高 度 ; 第 二 部 分 是 在 脚 着 地 时 控制 它 相 对 
于 散 部 的 距离 来 控制 整个 系统 向 前 的 速度 ; 最 后 一 部 
分 是 在 站 立 阶段 通过 伺服 骨 部 轨迹 来 控制 身体 的 姿 
态 。 这 些 算法 非常 简单 且 能 够 实时 实现 。 有 趣 的 是 这 
种 简单 的 方法 几乎 可 以 直接 用 于 三 维 (3-D) 单 腿 跳 
跃 的 机 器 人 ( 见 图 16.2a (原文 有 误 ))。 此 外 ， 这 种 
由 三 部 分 组 成 的 控制 方法 同样 可 以 拓展 到 双 足 ( 见 图 
16.2b (原文 有 误 ) ) 或 者 四 足 机 器 人 ， 仅 要 增加 腿 运 
动 次 序 的 控制 技术 以 及 双 腿 协同 运动 时 的 虚拟 腿 概念 。 


实际 上 ， 这 项 有 趣 的 工作 并 没有 继续 下 去 ， 但 是 


它 启 发 了 许多 周 


期 系统 的 研究 。 在 这 些 系 统 中 纯 被 动 


机 器 人 已 经 受到 广泛 的 关注 ， 我 们 现在 将 深入 到 这 一 


领域 。 


16.2.2 被 动 行走 的 稳 


这 一 小 节 的 目的 是 介绍 一 些 与 被 动 行走 相关 的 基 


定性 


本 事实 和 概念 。 更 多 的 细节 可 以 在 相关 文献 中 找到 ， 


例如 参考 文献 【16.1，4， 
来 自 参 考 文献 [167]. R 


6]。 本 文 涉 及 的 内 容 主 要 
们 采用 最 简单 的 模型 (I 


图 16.3) ， 一 个 没有 驱动 的 平面 对 称 圆规 模型 从 倾角 
为 中 的 斜坡 上 向 下 走 。 所 有 质量 都 是 点 状 的 ， 无 质 


量 的 伸缩 腿 


用 来 保证 腿 摆 动 时 不 刊 地 。 这 个 模型 以 一 


些 假设 为 基础 。 我 们 仪 提 及 其 中 的 一 点 ， 即 假设 摆动 


过 程 中 不 会 产生 滑动 ， 并 且 双 脚 支 撑 阶 段 ， 


也 就 是 摆 


动 腿 和 支撑 腿 互 换 的 过 程 是 瞬间 完成 的 。 相 关 的 碰撞 
是 无 滑动 和 非 弹 性 的 。 我 们 定义 (根据 图 16.3 中 的 


au 
m a 
x= 


[4,4 1' 2 [44.4.5 Ine 4.] 


(16.1) 


T 


机 器 人 摆动 阶段 的 方程 类 似 于 无 摩擦 双 摆 的 方 
程 ， 可 以 用 拉 格 朗 日 动力 学 方程 的 形式 表述 如 下 


H(q)4 +C(q,q) 


式 中 
g 
H = 
ta) e +B) Bcos2a 
C(q.q) = 


| 0 
- (1 +B) Bq,sin(q, — Gu) 


T;(q) il [ua 


- 1 
dn) =0, (16.2) 


- (14+B)Bcos2a 
(148)'(u 41) =1 


(1B) Bq.sin(q, - du) 
0 


gGsing,, 


1)(1 +8) +1] gsing, 


式 中 ，2a 是 髋 部 两 腿 的 夹 


3o 


与 操作 机 器 人 相 比 ， 这 个 系统 的 特点 是 我 们 必须 


图 16. 2 Raibert 的 跳跃 机 器 人 [165] 
a) 三 维 单 足 跳跃 机 器 人 (1983) 
b) 三 维 双 足 机 器 人 (1989) 


在 连续 的 动态 学 方程 之 外 增加 描述 步 间 变换 的 方程 。 
我 们 将 在 介绍 双 足 行走 系统 的 动力 学 时 再 次 遇 到 同样 
的 要 求 ， 即 腿 的 运动 在 不 同 阶段 需要 分 别 建 模 (UL 
16.3.25), 

机 器 人 落地 碰撞 前 后 的 构 型 可 以 
描述 : 


用 如 下 关系 


q'-Sq. 
XB, S 是 一 个 2 x2 的 归 一 化 的 反对 称 矩 阵 。 对 模 
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图 16.3 圆规 模型 


型 应 用 角 动 量 守恒 原理 可 以 得 到 O- (a) qo = 

Q'(o)q ^ ,从 中 我 们 可 以 得 到 关节 速度 的 关系 g + = 

[Q^(0)]'Q (o)q =A(a)g ,其 中 

-~ (-B -B+[m(1 +B)? +2(1+B)]cos2a 

m -( 0 -6 ) 
BLB - (1 +8) cos2a] 


CQ (a) = 
p 
(1 €) [ (1 +8) -Bcoz2a ] 
eb 4u(1 +B)’ | 
-B(1 +B) cos2a 
碰撞 前 和 碰撞 后 完整 的 状态 向 量 % 可 以 写成 
x' -W(a)x- 

. S 0 
AF, W (a) E " mn 

这 个 系统 的 周期 性 动力 学 行为 可 以 概括 为 图 
16. 4 所 示 的 相 平 面 图 ， 其 中 不 连续 的 相 轨 迹 由 碰撞 
所 产生 。 这 个 系统 的 稳定 性 可 以 用 轨道 稳定 性 来 分 
析 ， 其 理论 定义 可 参见 [16.7]。 直 观 上 ， 它 的 意思 
是 当 系统 在 相 平 面 上 的 某 一 个 区 域 〈 吸 引 域 ) P Ah 
离 它 的 轨迹 ， 它 的 自然 行为 是 回 到 这 个 称 为 极限 环 的 
相 平 面 轨迹 上 。 
轨道 稳定 性 的 概念 非常 适合 于 分 析 周 期 系统 ， 例 
如 进入 稳 态 后 的 行走 运动 。 由 此 ， 这 些 步 态 的 鲁 棒 性 
可 以 用 吸引 域 的 大 小 来 衡量 。 但 是 ， 对 于 一 般 的 非 线 
性 系统 , 证明 极 限 环 的 存在 、 分 析 轨 道 的 局 部 稳定 


(16.3) 


li 


O sk (16.4) JRBEF (x,,,5, Aik, 应 为 F (x, 4s 


dotted leg 


图 16.4 典型 极限 环 


性 、 计 算 其 周期 以 及 吸引 域 的 过 程 通常 都 很 困难 。 例 
如 ， 在 上 述 例子 中 ， 分 析 过 程 中 要 对 摆动 过 程 的 动力 
学 方程 进行 显 式 积分 。 无 论 如 何 ， 一旦 找到 了 一 个 极 
限 环 ， 要 分 析 它 的 局 部 稳定 性 还 是 可 能 的 。 一 种 确定 
机 恬 人 步 态 稳定 性 的 方法 是 对 其 庞 加 莱 映 射 进 行 的 数 
值 计算 "和 。 极 限 环 就 是 这 个 映射 的 不 动 点 ， 此 映射 
在 双 足 运动 分 析 中 被 称 为 跨 步 方程 下 。 本 质 上 这 些 
步骤 包括 在 极限 环 周围 的 对 状态 施加 小 的 扰动 ， 然 后 
计算 敏感 度 和 矩阵 的 特征 值 。 对 于 一 个 轨道 稳定 的 环 ， 
它 的 所 有 特征 值 都 位 于 单位 圆 内 。 一 种 自然 的 庞 加 莱 
截面 选取 方法 是 取 摆 动 腿 着 地 时 的 状态 。 由 此 对 系统 
动力 学 方程 进行 了 自然 的 离散 化 。 对 同一 只 腿 的 相 邻 
两 次 着 地 ， 机 器 人 状态 之 间 的 关系 可 表示 为 
x, 2 F(x, 4) (16.4) 

平衡 点 就 是 x”= F(x") 的 解 。 对 它 进 行 一 阶 展 开 ， 
我 们 得 到 

F(x' c Ax') =x" +(VF) Ax" (16. 5) 
Hb, (VF)Ax" eF(x" - Ax ^) -x^ ， 并 且 可 以 用 
一 种 数值 计算 的 方法 来 检查 (VF) 的 特征 根 的 模 是 
否 严 格 小 于 1。 一 种 方法 是 对 每 一 个 状态 变量 分 别 施 
加 一 个 很 小 的 扰动 ， 并 观察 它们 的 首次 映射 ， 然 后 对 
方程 (VF) T= 由 进行 数值 解 ， 其 中 4 x4 的 对 角 阵 T 
是 对 状态 变量 的 扰动 ，y 是 首次 映射 后 测量 出 来 的 状 
态 变 化 。 这 种 方法 是 很 通用 的 ， 而 且 在 其 他 具有 周期 
性 行为 的 机 械 系统 中 也 可 以 应 用 。 

已 经 证 明 被 动 行走 机 右 人 具有 稳定 的 极限 环 。 通 
常 ， 对 一 个 特定 范围 内 的 斜坡 角度 $， 这 种 稳定 行为 
只 有 一 个 。 有 趣 的 是 ， 增 大 由 会 导致 倍 周期 的 出 现 ， 
WR 由 太 大 还 会 演变 成 混沌 现象 ， 如 图 16.5 所 示 。 
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0.20 0.00 163 235 307 379 
斜坡 角度 6%/ C) 


图 16.5 分 叉 与 混沌 


总 之 ， 应 该 强调 的 是 这 类 机 器 人 已 经 启发 了 一 些 
ee co Nó dd 
角度 来 说 呈现 出 自然 的 被 动 步 态 的 系统 是 最 优 的 。 

个 极限 环 对 应 于 舒适 的 人 类 行走 步 态 ， 在 这 种 步 态 
下 ， 每 单位 距离 所 消耗 的 新 陈 代谢 能 量 是 最 小 的 。 因 
此 一 个 有 趣 的 想法 是 在 一 个 被 动 系统 中 加 入 一 组 数量 

最 少 的 驱动 器 来 补偿 当 系统 不 在 斜坡 上 行走 时 所 损失 
的 能 量 。 一 些 实验 室 的 机 器 人 就 是 基于 这 个 原理 ， 但 


是 这 一 思想 还 有 待 于 向 可 实际 应 用 的 有 腿 机 器 人 上 
开拓 。 
16.3 采用 正 动力 学 的 双 足 机 器 人 


空 制 


本 节 描 述 了 正 动力 学 框架 下 双 足 机 器 人 的 建 模 与 
控制 的 研究 现状 。 由 于 篇 幅 的 限制 ， 这 里 不 允许 详细 
描述 方程 的 细节 和 推导 过 程 。 因 此 ， 我 们 向 读者 给 出 
基本 内 容 的 同时 还 列 出 了 完整 的 参考 文献 ， 例 如 参考 
文献 [16.8，9] ， 相 关 的 深入 分 析 可 主要 参考 文献 
[16.10, 11]. 


16.3.1 构 型 空间 


双 足 机 峰 人 通常 被 建 模 成 一 个 刚性 树 状 的 三 维 匀 

结构 。 基 本 上 ， 关 节 间 的 参数 用 g, 表示 ， 所 形成 
的 关节 空间 为 0。 如 果 认 为 机 器 人 的 脚 在 摆动 过 程 中 
是 不 运动 的 ， 那 么 这 个 模型 就 与 经 典 的 操作 臂 相同 。 
如 果 其 所 有 关节 都 有 驱动 ， 那 么 在 站 立 阶 段 〈( 双 脚 
都 在 地 上 ) ， 封 闭 的 方程 组 就 造成 机 器 人 的 元 余 驱 
动 。 然 而 更 正确 且 通 用 的 方法 是 把 机 器 人 看 做 空间 中 
的 一 个 自由 系统 ， 但 受到 非 定常 的 单 边 约束 。 因 此 其 
构 型 空间 是 | 10|@R @50(3)|， 其 中 一 个 给 定 物 
体 的 六 维 位 移 用 参数 表示。 


16. 3.2 动力 学 


基本 的 建 模 方法 把 动力 学 方程 分 成 三 部 分 : 完整 
空间 内 的 拉 格 朗 日 动力 学 方程 、 接 触 力 产 生 的 约束 方 
换 方程 。 

连续 动力 学 与 接触 力 

20 A NE 连续 
表示 成 拉 格 朋 日 方程 的 形式 

H(q)4 *C(q.4)q *G(q) =T +r (16.6) 
XUP.a4-2(q4,45)67, HOEX 16.3.1 节 ; = 
[0, 1] e A MAR, FE udo s ua 715p 
(通常 是 有 界 的 ); Te 2"; H 是 惯性 矩阵 ; CHA 
心 、 回 转 和 科 氏 作用 的 和 矩阵; Ts 是 广义 重力 向 量 。 
集合 (q, q) 构成 机 器 人 的 状态 。 

机 器 人 与 地 面 的 接触 点 满足 以 下 形式 的 封闭 方程 

$,(q) 
&o «(5 J 

He fot ^ HE AY IB, ， 可 以 表示 成 


I, -J(4)'A(4, 4) 


式 中 ,J(g) = SACA) je gut A flf rs UTER HAS 


动力 学 可 以 


Te FA HIR 


阵 ， 这 个 点 也 是 外 力 施 加 作用 的 点 。A(g，9 ) 是 拉 
格 朗 日 乘 子 ,我们 可 以 把 这 个 表达 式 分 成 两 部 分 
Ta -J,(4)A,(4,4) *J,(4 A (4,4) 
TF n 和 +4 分别 代表 地 面 的 法 向 和 切线 方向 。 拉 格 朗 
HRF A,A 和 ,表示 这 些 方向 上 作用 力 的 幅 值 。 
目前 ， 对 与 地 面 接触 的 建 模 有 两 种 主要 的 方法 。 
首先 ， 可 以 采用 黏 弹性 模型 ， 但 是 可 能 会 遇 到 物理 分 
析 和 数值 积分 的 困难 。 其 次 ， 我 们 会 采用 相反 的 做 
法 : 认为 与 地 面 的 接触 是 刚性 的 ， 这 会 导致 增加 一 组 
约束 ， 即 所 谓 的 单 边 约束 ， 例 如 脚 不 会 陷入 地 面 。 因 
此 ， 接 触 点 非 负 的 法 向 作用 力 和 加 速度 就 可 以 通过 补 
充 条 件 联系 起 来 号 。 


A'(g,g) ,(q) =0,à, (4,4) 20,0, (4) 20 
把 系统 滑动 的 情况 排除 在 外 ， 切 向 力 的 约束 可 以 写成 


p,(q) =0 
最 终 ， 因 为 存在 的 摩擦 力 限 制 了 允许 的 切 向 力 ， 那 么 
只 要 下 面 的 不 等 式 存在 就 会 满足 不 滑动 的 条 件 
|A, ||, 
式 中 , jw 是 由 相 接 触 的 材料 所 决定 的 摩擦 系数 。 
2. 碰撞 
如 16. 2.2 节 所 述 ， 如 果 碰 撞 被 假设 成 非 弹性 且 
无 滑动 的 ， 那 么 根据 以 下 的 碰撞 方程 ， 系 统 的 速度 会 
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M q - 跳 变 到 g * 
H(q)(q*-q^)-J,(4)'A,(4,4) + 
J,(g) A.(g,gq) 
RF, A(q,q) 2[A.(4,4), A (q, q) Æ 
击 力 。 
在 假设 碰撞 后 接触 点 不 移动 的 情况 下 ， 我 们 可 以 


写 出 


«m 


$,(q) -J,(q)q' =0 IO, (q) -J,(q)q* =0 

3. 动态 平衡 

本 质 上 ， 如 果 一 个 双 足 机 器 人 能 维持 行走 而 不 跌 
倒 ， 它 就 处 于 平衡 。 在 机 器 人 技术 的 初期 ， 步 态 是 静 
态 的 。 这 就 意味 着 当 速 度 和 加 速度 很 小 、 并 且 假 设 接 
触 点 在 一 步 中 的 任何 时 候 都 是 不 动 的 ， 那 么 平衡 的 条 
件 就 简化 为 一 个 经 典 的 条 件 : 机 器 人 质心 的 投影 位 于 
接触 点 所 形成 的 凸 多 边 形 内 。 因 此 ， 静 态 行走 可 以 定 
义 为 一 个 连续 的 构 型 序列 ， 这 个 序列 既 保证 机 器 人 向 
前 的 行进 ， 同 时 又 维持 系统 竖 直 的 姿态 ， 使 机 器 人 在 
每 一 瞬间 都 满足 静态 平衡 条 件 。 后 面 我 们 会 看 到 ， 很 
容易 设计 相关 的 控制 算法 。 

但 是 ， 真 正 有 趣 的 问题 是 动态 平衡 。 这 个 问题 已 
在 16. 2. 2 节 中 Raibert 的 跳跃 机 器 人 或 轨道 稳定 的 被 
动机 器 人 中 进行 了 很 好 地 论述 。 其 他 双 足 机 器 人 中 的 
稳定 性 和 平衡 问题 需要 更 深入 的 分 析 ， 正 如 参考 文献 
[16. 11] 中 所 描述 的 工作 。 

对 于 一 个 双 足 机 器 人 ， 动 态 平 衡 可 以 直观 地 与 可 
能 运动 的 思想 联系 起 来 。 我 们 先 回 到 动力 学 方程 ; 将 
方程 按 与 构 型 空间 的 两 部 分 相 一 致 的 方式 分 解 ， 动 力 
学 方程 (16.6) 就 可 以 重 写成 ， 


H,(q) 4 *C,(q4,4)qd =T+J,(q)'A- Ta (q) 


H,(q) q *C,(q4,4)q =0+J,(q)'A- T2(q) 
(16.7) 


式 中 的 了 是 一 组 驱动 力矩 。 

参考 文献 [16.11] 指出 式 (16.7) 的 第 二 个 
方程 左边 部 分 等 效 于 系统 动态 转 和 矩 ， 而 右边 部 分 与 
接触 力 和 重力 所 产生 的 转 矩 等 价 。 该 方程 以 牛顿 - 欧 
拉 方 程 的 形式 给 出 ， 其 中 牛顿 部 分 可 以 容易 地 用 机 
器 人 质心 处 的 加 速度 表示 。 其 根本 问题 是 : 机 器 人 
的 全 局 位 置 和 方向 只 能 通过 接触 力 来 实现 。 进 而 ， 
这 个 运动 必须 和 姿势 的 改变 相 联 系 。 更 一 般 地 ， 当 
且 仅 当 重 力 和 接触 力 与 机 器 人 的 动态 转 矩 相等 时 ， 
这 个 系统 才能 实现 所 要 求 的 运动 。 对 于 一 个 给 定 的 
控制 算法 ， 问 题 就 变 成 检验 机 器 人 在 控制 的 作用 下 


是 否 满足 这 个 条 件 。 

当 所 有 接触 点 都 在 同一 个 平面 时 ， 可 以 证 明 在 
这 个 平面 上 存在 这 样 一 个 点 ， 重 力 和 动态 力 相对 该 
点 都 没有 水 平方 向 的 力矩 。 这 个 点 就 是 著名 的 零 力 
矩 点 (ZMP)，, 它 也 是 压力 的 中 心 点 (CoP)。 在 
16.4 节 中 可 以 看 到 这 个 概念 是 如 何 得 到 有 效 的 控制 
策略 的 。 

另外 一 种 解决 行走 机 器 动态 平衡 问题 的 方法 考虑 
了 非 水 平 力 和 切 向 力 ， 其 表述 如 下 。 一 个 行走 系统 在 
给 定 的 时 间 内 要 实现 一 个 特定 轨迹 g(1) 所 指定 运动 
的 必要 条 件 是 存在 一 个 接触 力 和 (1:) ， 使 得 

H,(g) d *C,(q,4)4 + To(q) =J,(q)"A 

See 


(16. 8) 
其 中 的 向 量 不 等 式 4(A) 20 包含 了 所 有 法 向 ( 单 
边 ) 约束 和 切 向 力 ( 科 氏 力 )。 最 终 ， 当 驱动 力 与 式 
(16.7) 的 第 一 个 方程 的 动态 要 求 相 一 致 时 ， 这 种 运 
动 就 一 定 会 实现 。 在 接 下 来 的 这 一 节 ， 我 们 会 提出 一 
种 与 此 相关 的 控制 算法 ， 来 展现 这 种 方法 。 


16.3.3 轨迹 生成 


设计 完整 的 双 足 行走 控制 策略 的 一 种 常用 方法 包 
括 两 部 分 : 预先 定义 的 期 望 运动 轨迹 ， 采 用 经 典 控制 
就 可 以 实现 对 这 些 轨迹 的 跟踪 ; 解决 模型 的 不 确定 
性 、 障 碍 和 干扰 的 专用 在 线 调节 技术 ,来 防止 机 器 人 
HE. AME (也 称 为 参考 ) 轨迹 的 方法 主要 有 
两 种 ， 既 可 以 来 源 于 人 类 运动 的 捕 提 ， 也 可 以 纯粹 由 
计算 机 生成 。 对 于 后 者 ,通常 的 做 法 包括 两 步 : 首 
先 ， 要 选择 一 组 适当 维 数 的 输出 变量 。 它 们 通常 从 一 
些 机 器 人 上 选 定点 的 三 维 坐 标 中 获得 。 其 次 ， 在 参数 
化 之 后 (例如 ， 以 样 条 的 形式 )， 就 可 以 用 这 些 参量 
计算 一 步 所 有 阶段 的 轨迹 ， 包括: 站立、 摆动 、 向 左 
和 向 右 等 ， 这 就 允许 把 障碍 或 者 台阶 考虑 在 内 了 。 这 
些 轨迹 可 以 是 时 间 上 同步 的 ， 也 可 以 是 仅 以 时 间 为 参 
考 坐 标的 函数 。 完 成 这 种 计算 最 有 趣 的 方法 是 使 用 一 
个 基于 动力 学 的 优化 算法 ， 这 个 算法 同时 考虑 了 各 种 
约束 。 轨 迹 可 以 保持 在 特定 的 输出 空间 ， 也 可 以 变换 
成 关节 空间 中 的 关节 轨迹 q(t). Bo, RASH 
由 一 个 控制 器 来 跟踪 的 ， 后 面 会 有 所 解释 ; 通常 还 会 
加 入 一 个 在 线 稳定 器 。 

要 介绍 的 另外 一 种 方法 是 应 用 生物 启发 技术 的 可 
能 性 ， 例 如 中 枢 模 式 发 生 器 。 这 个 想法 是 设计 自 激 振 
HRA ( 即 没有 输入 ， 但 是 输出 可 以 通过 一 些 参数 
来 调整 ) ， 从 中 可 以 获得 各 关节 的 周期 性 同步 运动 。 
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这 种 方法 通常 用 来 生成 多 腿 机 器 人 【四 足 ， 六 足 ) ， 
或 者 像 蛇 一 样 系 统 的 步 态 ,但 也 有 一 些 工 作 涉 及 双 足 


是 在 动态 行走 的 框架 内 产生 的 ， 例 如 把 ZMP 的 期 望 
位 置 考虑 在 内 ， 这 个 算法 也 可 以 应 用 于 动态 行走 ， 可 


机 器 人 中 。 最 著名 的 非 线性 振荡 器 是 范 德 波 尔 
方程 

y ta(l -by )y t+ey=0 (16.9) 
从 这 个 方程 可 以 得 到 许多 演变 的 形式 。 类 似 的 结果 可 
以 用 更 具有 生物 启发 的 方法 得 到 ， 即 设计 神经 元 振荡 
ae) CER RRA, WERA IE SK 
的 人 造 神经 元 连接 成 网 络 来 生成 合理 的 行走 模式 。 在 
某 些 情况 下 ， 甚 至 可 能 创造 某 种 反馈 来 适应 环 的 境 变 
化 或 用 于 提高 稳定 性 的 2 。 


16.3.4 控制 


本 节 我 们 只 简要 地 列举 三 个 控制 算法 的 例子 。 
实 上 ,文献 中 已 经 报道 了 各 种 各 样 的 控制 算法 ， 且 仪 
一 章 的 篇 幅 不 可 能 对 此 进行 详尽 的 论述 。 因 此 ， 我 们 
建议 读者 参考 这 一 领域 最 好 的 期 刊 和 会 议 来 了 解 更 多 
的 信息 16721 。 

1. 简单 的 动力 学 控制 

为 简单 起 见 ， 让 我 们 仅 考虑 一 种 特定 的 情况 ， 即 
对 行走 的 每 个 不 同 阶 段 ， 用 一 组 多 维 的 参考 关节 轨迹 
qu(t) 来 指定 所 期 望 的 行走 行为 。 在 理想 情况 下 ， 有 
必要 设计 一 种 控制 算法 来 准确 跟踪 。 通 常 ， 针 对 跟踪 
误差 的 比例 积分 微分 (PID) 回路 是 这 种 控制 算法 的 
核心 。 然 而 ， 因 为 噪声 的 存在 和 离散 化 的 原因 ， 在 
PID 控制 器 中 使 用 高 增益 并 不 总 是 可 取 的 ， 良 好 的 跟 
踪 性 能 要 求 把 机 械 系统 的 建 模 纳入 到 控制 系统 中 。 在 
系统 的 动力 学 特性 已 经 很 清楚 的 情况 下 ， 在 所 请 的 计 
算 力 矩 法 中 使 用 它们 通常 会 非常 有 意思 ， 这 种 方法 施 
加 的 控制 力矩 的 一 般 形式 为 


T'=H(q)(h, (9-41) *k(q -d) + 4u) 4 


C(q,4)4 + &(q) «I, (16. 10) 
与 式 (16.6) 的 动力 学 方程 相 比 ， 变 量 上 的 冒号 表 
示 近 似 模型 。7, 涵 盖 了 所 有 的 摩擦 ; k, 是 控制 增益 。 
这 种 形式 是 在 关节 空间 中 给 出 的 ， 但 是 它 也 可 以 用 于 
其 他 微分 同 胚 的 输出 空间 。 需要 指出 ， 对 于 这 些 模 
型 ， 我 们 至 少 应 该 考虑 重力 补偿 名 (9) 。 此 外 ， 最 重 
要 的 误差 来 源 之 一 是 内 部 的 摩擦 作用 。 一 旦 在 关节 、 


齿轮 和 了 驱动 上 应 用 摩擦 模型 ， 就 会 有 了 ;， 必 须 仔 细 
地 使 用 这 些 模型 。 实 际 应 用 中 ， 如 果 存 在 脚底 开关 ， 
那么 这 种 传感器 就 会 触发 行走 的 相 切换 、 腿 的 同步 和 
行走 周期 的 再 初始 化 ( 见 7.4 节 )。 

这 种 控制 至 少 可 以 用 来 产生 静态 行走 。 如 果 轨 迹 


pg 


lll 


能 同时 还 需要 增加 特定 的 稳定 性 算法 。 这 个 策略 的 许 
多 变形 都 是 基于 对 动力 学 方程 的 线性 化 ， 或 者 倒立 摆 
模型 。 

尽管 这 种 控制 可 以 克服 一 些 内 部 干扰 ， 但 是 它 既 
不 能 实时 和 鲁 棒 地 确保 行走 的 稳定 性 ， 也 不 能 适应 环境 
的 不 确定 性 。 现 在 最 基本 的 要 求 是 找到 一 种 控制 地 面 
接触 力 的 方法 ， 以 此 来 确保 支撑 脚 按 参考 轨迹 的 要 求 
而 保持 不 动 。 这 意味 着 控制 必须 保证 不 等 式 条 件 
(没有 滑动 ， 没 有 离 地 ) ， 它 涉及 16.3.2 节 中 提 及 的 
拉 格 朗 日 乘 子 在 每 一 时 刻 无 论 有 没有 扰动 都 要 满足 条 
件 。 然 而 ， 这 种 反应 能 力 会 被 驱动 器 边界 所 限制 。 

解决 在 线 行走 稳定 性 的 一 个 有 效 方法 是 把 控制 分 
AUP pO) :第 一 部 分 用 来 跟踪 预先 设 定好 的 
轨迹 ， 它 涉及 大 部 分 关节 。 第 二 部 分 是 通过 部 分 选 定 
的 关节 (躯干 ， 更 通常 的 是 趴 关节) 来 控制 地 面 反 
力 。 可 以 证 明 ， 通 过 适当 的 柔顺 模型 控制 躁 关节 力矩 
可 间接 地 控制 地 面 反 作用 力 。 与 机 器 人 操作 手中 的 混 
合 控制 方法 相 类 似 ， 有 具体 实现 时 可 以 或 多 或 少 地 直接 
采用 接触 转 矩 ， 这 个 转 矩 来 自 中 关节 或 者 脚 上 的 力 或 
力矩 传感器 。 

2. 一 个 变种 : 参数 化 轨迹 的 使 用 

经 典 轨迹 跟踪 方法 的 缺点 是 它 必须 准确 地 设计 出 
所 有 可 能 的 轨迹 。 因 此 适应 扰动 时 要 从 一 条 轨迹 突变 
到 另 一 条 轨迹 。 例 如 ， 为 了 跨 过 一 个 小 障碍 需要 增 大 
或 者 减 小 总 速度 时 ， 控 制 器 就 要 改变 预先 设 定 步 伐 的 
形状 、 时 间 和 步 长 。 一 种 有 趣 的 尝试 是 得 出 系统 的 在 
线 系统 行为 调节 方法 ， 它 通过 参数 化 给 所 定义 的 被 跟 
BRAN I BHP AY A REP") 。 这 种 方法 的 原理 介 
绍 如 下 。 

首先 考虑 ， 实 际 上 参考 轨迹 是 依赖 于 一 组 时 变 
的 二 阶 可 导 参 数 p:q, = ql p(t) ]。 轨 迹 的 许多 特征 
都 会 在 bp 上 表现 出 来 : 步 长 、 脚 跟 轨 迹 的 最 高 点 和 
时 间 缩 放 比 例 等 。 例 如 ， 这 些 参数 反映 在 定义 参考 
轨迹 的 样 条 曲线 的 系数 里 。 根 据 需 要 的 运动 它们 被 设 
定 为 一 个 值 : p^ 。 因 为 假定 当 需 要 时 它们 会 发 生变 
化 ， 所 以 就 必须 设 定 它们 的 动态 过 程 会 通过 二 阶 线性 
的 p,-f(p, p, p^) WISlp* 。 现 在 可 以 证 明 获 得 动 
力学 特性 是 可 能 的 ， 包 括 类 似 于 式 (16.10) 的 PD 
控制 策略 ， 接 触 力 的 单 边 性 、 不 滑动 及 不 离 地 的 要 求 
和 驱动 器 的 界限 。 这 些 已 在 16.3.2 节 中 说 明 过 ， 并 
会 在 参考 文献 [16.8] 中 概括 成 一 个 单 向 量 的 不 
等 式 
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A(q.d p.p. p) <0 (16. 11) 

现在 ， 通 过 寻找 一 个 恰当 的 优化 方法 解决 了 这 个 
问题 (例如 FSQP: 可 行 序 贯 二 次 规划 ， 起 源 于 马里 
兰州 大 学 系统 研究 所 ) 。 当 保证 满足 式 (16.11) 时 ， 
参数 的 加 速度 p 就 会 使 | p,- bp 必 变 小 。 这 种 方法 
可 以 补偿 作用 于 其 上 的 外 部 力 的 扰动 ， 因 为 它们 会 反 
决 在 内 部 状态 上 ， 所 以 可 以 通过 不 等 式 (16.11) 来 
满足 。 参 考 文献 [16.26] 已 经 证 明 ， 和 非 适 应 性 方 
法 相 比 ， 通 过 使 用 这 种 方法 可 以 成 10 倍 地 增 大 可 接 
受 扰动 的 范围 。 此 外 ， 使 用 外 部 传感器 〈 例 如 距离 、 
接近 和 视觉 ) 能 够 立即 对 参数 进行 修改 ， 例 如 为 了 

台阶 或 者 避免 一 个 障碍 。 

3. 在 线 优化 

实时 地 调节 机 器 人 运动 的 最 终 方 法 是 避免 使 用 
任何 预先 计算 好 的 轨迹 。 这 就 要 求 给 定 的 运动 和 相 
关 的 控制 都 可 以 在 线 完 成 。 在 最 一 般 的 情况 下 ， 甚 
至 可 以 设想 将 这 两 步 融合 为 一 种 方法 。 此 外 ， 幸 亏 
艇 入 式 计 算 能 力 的 指数 增长 ， 才 使 得 现在 有 可 能 精 
确 地 计算 动力 学 模型 ， 并 且 实 时 地 使 用 复杂 的 优化 
技术 。 这 就 是 为 什么 我 们 要 以 可 行 的 基于 优化 的 方 
法 来 结束 本 章 的 这 一 部 分 ， 这 种 方法 避免 了 解析 轨 
迹 的 生成 。 

(1) 模型 预测 控制 (MPC)。 这 个 想法 来 源 于 著 
名 模型 预测 控制 技术 ， 它 基于 以 下 原理 。 我 们 先 假设 
存在 一 个 足以 综合 出 控制 系统 的 动态 模型 。 然 后 ， 在 
每 一 个 采样 时 间 完 成 以 下 的 每 一 步 : 

1) 实际 状态 的 测量 。 

2) 计算 控制 量 ， 这 个 控制 从 当前 的 离散 时 间 
开始 在 有 限 的 范围 内 优化 一 个 依赖 于 状态 的 成 本 
函数 。 

3) 只 在 第 一 次 应 用 控制 输入 。 

4) 回 到 第 一 步 。 

这 个 标准 方法 的 主要 缺点 是 : 可 得 到 的 关于 稳定 
性 的 理论 结果 目前 只 适用 于 线性 的 或 者 非常 特殊 的 非 
线性 系统 。 例 如 ， 非 线性 模型 预测 控制 (NMPC) 在 
某 些 假设 下 才 可 以 呈现 出 稳定 性 。 此 外 ， 它 有 能 力 处 
理 约束 ， 这 使 得 它 适合 于 解决 行走 模式 生成 及 具有 单 
边 约束 或 由 非 结 构 化 环境 下 引入 干扰 的 双 足 机 器 人 的 
控制 问题 。 关 于 MPC 和 NMPC 完整 的 理论 和 实践 结 
果 可 以 见 参 考 文献 [16.27]。 但 是 ， 从 这 些 文章 中 
可 以 看 出 当 处 理 像 机 器 人 这 样 的 高 动态 系统 时 ， 应 用 
这 样 的 算法 是 不 容易 的 。 

(2) 无 轨迹 NMPC。 沿 着 之 前 所 说 的 实时 地 通 
SQP ( 序 贯 二 次 规划 ) 来 最 小 化 成 本 函数 的 参数 调 


d OE 


方法 ,产生 的 另 一 个 方法 是 在 每 个 时 间 点 解决 一 个 约 


束 优化 问题 3。 加 入 了 


问题 。 


一 组 约束 是 为 了 确保 行走 


的 可 行 性 和 满足 用 户 的 要 求 。 那 么 定义 这 些 约束 就 是 
作 一 的 方法 ， 这 样 就 可 以 描述 机 器 人 运动 的 所 有 


作为 这 种 方法 的 一 个 具体 例子 ， 我 们 就 考虑 正常 
稳 态 行走 的 摆动 阶段 。 不 等 式 约束 属于 两 个 不 同 的 


子 集 。 


1) 与 安全 相关 的 内 在 约束 。 


(D 物理 限制 : 允许 的 
合 ， 这 个 集合 可 能 依赖 了 
度 是 有 界 的 。 
D 保证 稳定 : 在 整个 


AL 


控制 力矩 属于 一 个 给 定 的 
FF 关节 的 瞬间 速度 ; 关节 和 角 


摆动 阶段 ， 支 撑 脚 的 法 向 


接触 力 严格 大 于 给 定 的 正 值 ; 切线 力 的 绝对 值 小 于 给 


定 的 门槛 ， 这 个 门槛 依赖 ] 
2) 与 具体 步 态 相 关 的 
(D 实现 向 前 移动 : 1X 


F 摩擦 因数 。 
约束 。 
动 腿 躁 关节 的 水 平 速 度 在 


给 定 的 一 个 正 数 范围 内 ， 骨 侈 的 水 平 位 置 保持 在 支撑 


脚尖 和 摆动 腿脚 后 跟 的 水 了 


位 置 之 间 。 


D 控制 姿势 : Zea IK 


干 弯曲 的 角度 是 正 数 ， 并 


且 是 有 界 的 ; 摆动 腿脚 底 和 地 面 的 角度 是 固定 的 ; Tr 


盆 的 高 度 有 下 界 。 
O 确保 脚 不 刊 地 : BR 


的 高 度 限 制 在 一 个 给 定 的 


区 域内 (例如 ， 由 它 的 水 平 位 置 的 两 个 多 项 式 方程 
确定 )。 这 些 方 程 是 一 种 越过 障碍 息 人 台阶 的 方法 。 
所 有 这 些 约束 可 以 集中 于 向 量 不 等 式 g(. ) <0 


中 ， 等 式 约束 主要 有 : 
1) 动力 学 方程 (16.6 
2) 状态 的 初始 条 件 : 
的 末 状 态 。 


所 以 这 个 方法 是 一 个 优化 过 程 ， 从 输入 (控制 ， 
状态 ， 接 触 力 等 ) 到 前 面 提 到 的 约束 下 预期 系统 未 


来 的 行为 。 在 上 述 约束 下 ， 


) 本 身 就 表示 摆动 阶段 。 
在 时 间 na, CERA i 


在 有 限 的 时 间 范 围 内 使 用 


内 模 。 既 然 这 个 问题 最 终归 结 为 每 个 采样 时 间 点 上 的 


数 ， 并 使 它 最 小 化 。 通 常 ， 


与 预测 的 最 后 状态 相 联系 的 一 项 ， 这 一 项 还 和 能 量 


达 式 的 平方 有 关 。 


优化 算法 的 解 是 在 预测 N, 范 围 内 的 一 系列 控制 


输入 Ns 只 有 第 一 个 输入 


带 约束 的 开 环 优化 ， 所 以 最 后 一 步 是 定义 一 个 目标 隐 


这 样 的 一 个 成 本 函数 包括 


是 施加 在 系统 上 的 ， 并 且 


这 个 输入 施加 后 又 开始 了 一 个 过 程 。 必 须 注意 到 包含 


于 任何 实时 控制 中 的 反馈 作用 ， 它 是 在 优化 的 过 程 中 


通过 使 用 实际 当前 状态 值 来 实现 的 。 此 外 ， 为 了 对 无 
法 预测 的 事件 做 出 反应 ， 运 动 的 调整 可 以 通过 在 线 改 
变 等 式 和 不 等 式 的 约束 来 实现 。 
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机 器 人 结构 


例如 我 们 看 图 16.6。 这 里 状态 X; FETE ke 1 时 
刻 预 测 的 脚后跟 高 度 ， 它 是 从 时 刻 上 计算 得 出 的 。 然 
后 对 障碍 的 检测 就 会 导致 多 项 式 的 改变 ， 这 个 多 项 式 
是 轨迹 XX 的 下 限 。 根 据 预测 的 范围 最 终 就 可 以 预期 
系统 的 动态 行为 了 ， 这 就 保证 了 脚 在 通过 障碍 时 的 
安全 。 

这 种 方法 被 认为 是 无 轨迹 的 非 线 性 模型 预测 控 
制 ， 将 在 参考 文献 [16.28] 中 进行 详细 论述 。 预 测 
控制 方法 在 基于 ZMP 的 控制 中 的 扩展 在 参考 文献 
[16.29] 中 进行 论述 。 
控制 输入 


状态 时 间 


Xv X= 
E 障碍 (ee 


k kel k+2 k+3 k*N, 时 间 


图 16. 6 非 线性 模型 预测 控制 的 原理 


16.4 RA ZMP 方法 的 双 足 机 器 人 

零 力矩 点 (ZMP) 可 能 是 机 器 人 领域 中 最 著名 
的 技术 名 词 之 一 。 图 16. 7 是 基于 ZMP 的 双 足 行走 领 
域 的 两 个 重要 图 片 。 图 16.7a 是 由 Takanishi 和 Kato 
设计 的 WL-10RD。 这 是 第 一 个 基于 ZMP 的 机 器 人 ， 
它 在 1985 年 成 功 地 实现 了 动态 双 足 行走 “”i。 它 有 
12 个 自由 度 , 高 1.43m， 质量 为 84. 5kg， 由 液压 驱 
AIR o 

Al 16. 7b 是 ASIMO， 它 是 本 田 汽车 公司 在 2000 
年 研发 的 26 个 自由 度 的 仿 人 机 器 人 5321 。 它 是 公众 
心目 中 最 著名 的 机 器 人 之 一 ， 同 时 ， 它 良好 的 双 足 运 
动 (行走 和 跑 ) 能 力也 得 到 了 专家 们 的 认可 。 根 据 
发 表 的 文章 和 专利 ，ZMP 在 ASIMO 的 行走 控制 中 起 
了 重要 的 作用 。 

这 一 节 ， 我 们 介绍 ZMP 的 基本 定义 、 计 算 以 及 
使 用 。 


16.4.1 机 构 


图 16. 8 是 最 近 研 发 的 采用 ZMP 方法 控制 的 一 些 
双 足 机 器 人 。 图 16. 8a 是 Johnnie, Hi Gienger 等 于 
2001 EMR, EA IT 个 自由 度 , 高 1.80m， 质 
量 为 40kg， 由 带 谐 波 减 速 齿 轮 和 深 珠 丝 杠 的 直流 伺 


图 16.7 ZMP 方法 控制 的 双 足 机 器 人 [ta 99811 
a) WL-IORD(1985) b) ASIMO(2000) 


服 电动 机 驱动 。 图 16. 8b 是 HRP-2L, HH Kaneko 等 研 
USUS 它 有 12 个 自由 度 , B 14m, 质量 为 
58. 2kg， 由 带 谐 波 减 速 齿 轮 的 直流 伺服 电动 机 驱动。 
图 16. 8c 是 WL-16R， 由 Takanishi 等 研发 ， 它 是 一 个 
可 以 承受 质量 达 94kg ANSARI | EEA 
12+ B rH EE, 高 1.29m 的 双 足 机 器 人 ， 其 质量 为 
55kg， 腿 由 电动 直线 作 动 器 驱动 。 图 16. 8d 是 HU- 
BO, Hi Oh 等 研发 “5 。 它 是 一 个 有 41 个 自由 度 ， 
H 1.25m, 质量 为 55kg 的 仿 人 机 器 人 。 

尽管 这 些 机 器 人 有 不 同 的 腿 部 机 构 和 外 观 ， 但 是 
它们 有 以 下 这 些 相同 的 特征 : 

1) 每 一 条 腿 至 少 有 六 个 完全 驱动 的 关节 。 

2) 关节 是 位 置 控制 的 。 

3) 脚 上 装 有 力 传感器 ， 用 来 测量 ZMP, 

接 下 来 的 章节 中 我 们 会 看 到 ， 对 基于 ZMP 的 行 
走 机 器 人 有 一 些 基 本 要 求 。 


零 力 矩 点 (ZMP) 


FHEA (ZMP) 这 个 名 词 是 由 Vukobratovic 和 
Stepanenko 于 1972 年 创造 的 。 他 们 说 5 ， 

图 16.9 给 出 了 一 个 脚 上 力 分 布 的 例子 。 由 于 负 
载 在 整个 表面 具有 相同 的 符号 ， 它 可 以 简化 为 一 个 合 
力 R， 合力 的 作用 点 在 脚面 内 。 合 力 所 通 过 的 脚面 上 
的 这 个 点 就 是 零 力矩 点 ， 或 简称 ZMP。 

我 们 可 以 看 到 ZMP 被 定义 为 地 面 反作用 力 的 中 心 。 

在 未 来 的 讨论 中 ， 我 们 进一步 将 在 三 维 空间 中 讨 
论 地 面 反作用 力 的 细节 ， 如 图 16. 10 所 示 。 

假设 地 面 反 作用 力作 用 于 有 限 数量 的 接触 点 
piel, 0, N), 并且 每 个 力 向 量 的 形式 都 是 

fi 0L AF 


16. 4. 2 
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Hl168 ZMP 方法 控制 的 双 足 机 器 人 Ts 1 
a) Johnnie(2000) b) HRP-2L(2001) 
c) WL-16R(2003) d) HUBO(2006) 


图 16.9 RHEA (ZMP) 的 原始 定义 


式 中 , 上 、 记 和 上 及 分别 是 地 面 固 结 坐标 系 中 x，y Az 
方向 上 力 的 分 量 。ZMP 可 这 样 计算 
> ` BOR 


p = (16. 12) 


AR 


它 也 可 以 写成 


图 16. 10 三 维 空间 中 的 地 面 反作用 力 


p= Yap, (16. 13) 
a, - f/f. (16. 14) 
ED! (16. 15) 


E49 —A- YR TEE RE UR A EUR e P ME] 


f,20 (izl,-,N) (16. 16) 
那么 ， 我 们 就 可 以 得 到 ， 
«a, 20 (izl,-,N) 
N 16.17 
| 2. d =1 


满足 式 (16.13) MIÈ (16.17) 的 点 形成 支撑 多 边 
形 ， 即 支撑 点 所 形成 的 凸 多 边 形 。 因 此 ， 我 们 可 以 得 
出 结论 ，ZMP 总 存在 于 支撑 多 边 形 内 。 换 而 言 之 ， 
由 于 地 面 反作用 力 是 单 边 约束 ，ZMP 永远 不 会 离开 
支撑 多 边 形 。 
现在 来 计算 关于 ZMP WJA 
r-Y(, -p) xf, 

该 公式 写成 向 量 的 分 量 形式 为 


(16.18) 


t= Y (p, -p,a Y (pe -Pfa (16.19) 
ty = Y (Pa -Pfa - Y. bf. (06.20) 


T = 2, (ps - pM. - 2. (Ps -pJ)f, (16.21) 
式 中 ，p;,，p; 和 pi 是 位 置 向 量 p; 的 分 量 ; p,, p, All p. 
是 ZMP 的 分 量 。 

当地 面 为 水 平时 ， 对 于 所 有 的 i, 我们 有 p. =p.。 
因此 , st (16.19) 的 第 二 项 与 式 (16.20) 的 第 一 
WAZ, PEM, 将 式 (16.12) 带 入 式 (16.19) 和 
st (16.20), 得 : 


(16. 22) 
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这 就 是 p 点 被 命名 为 零 力 矩 点 的 原因 。 然 而 ， 必 须 注 
意 到 一 般 情况 下 摩擦 力 产生 一 个 非 零 的 竖 直 动量 式 
(16. 21) 


T: #0 (16.23) 
16.4.3 计算 ZMP: 由 机 器 人 的 运动 计 


算 ZMP 


给 定 了 机 融 人 的 动力 学 方程 和 运动 ， 我 们 可 以 通 
过 牛顿 定律 计算 或 者 预测 相应 的 ZMP。 为 了 区 分 于 
前 几 节 所 定义 的 原始 ZMP, 我 们 使 用 Vukobratovie 等 
文章 里 所 用 的 名 词 计算 ZMP 。 

1. 简单 的 例子 

让 我 们 从 一 个 很 简单 的 机 构 开 始 。 图 16. 11a 是 
一 个 行走 机 器 人 和 它 的 简化 模型 ， 由 一 个 在 无 质量 的 
桌子 和 其 上 的 运动 小 车 组 成 。 小 车 的 质量 为 M， 它 的 
位 置 相 对 机 器 人 的 质心 是 (x,z,) ( 见 图 16.11b)。 
同样 ， 假 设 桌 子 具 有 和 机 器 人 相同 的 文 撑 多 边 形 。 


图 16. 11 小 车 -桌子 模型 
a) 行走 机 器 人 和 它 的 简化 模型 b) 小 车 的 位 置 


这 种 情况 下 ,点 p 周围 的 力矩 + 就 是 
T= -Mg(x-p) +M Xz, (16. 24) 
NF, g 是 重力 加 速度 。 使 用 T=0 的 零 力矩 条 件 ， 
小 车 -桌子 模型 的 计算 ZMP 就 是 


Ze o. 
p=x-— x 
E 


(16.25) 


从 这 个 等 式 ， 我 们 可 以 得 出 关于 ZMP 的 两 个 基 
本 事实 : 

1) 小 车 的 加 速 的 是 零 时 ，ZMP 就 对 应 于 CoM 的 
TU. P= Xo 

2) 计算 ZMP 不 受 支 撑 多 边 形 的 限制 。 实 际 上 ， 
对 于 任何 给 定 的 P， 我 们 可 以 容易 地 确定 x 和 > 。 
第 二 个 事实 的 解释 如 图 16. 12a 所 示 。 当 小 车 的 
速度 过 大 时 ,计算 ZMP 就 超出 了 支撑 多 边 形 。 出 现 
这 种 情况 是 因为 式 (16. 25) 没有 考虑 支撑 多 边 形 和 
式 (16.16) PH BWA, MAS, X (1625) 


是 假设 脚 粘 在 地 上 了 。 如 果 恰 当地 考虑 了 单 边 约束 ， 
我 们 就 有 图 16. 12b 的 情况 。 因 为 桌子 不 再 是 竖 直 的 ， 
计算 ZMP 就 必须 用 下 面 的 方法 来 计算 


x (16. 26) 


p =x — — 
gtz 


它 给 出 了 在 支撑 多 边 形 边 缘 的 计算 ZMP。 


a) 


图 16. 12 ”计算 ZMP 
a) 假想 的 情况 b) 正确 结果 


在 许多 文献 里 ， 如 图 16. 12b 的 情况 没有 被 明确 地 
阐述 ， 但 是 在 假设 脚 粘 在 地 面 时 ， 计 算 ZMP 是 允许 离 
开支 撑 多 边 形 的 。 这 种 情况 下 ， 在 支撑 多 边 形 外 面 的 
计算 ZMP 暗示 了 机 器 人 的 脚 可 能 不 会 保持 和 地 面 的 完 
全 接触 ， 并 且 行 走运 动 也 不 会 像 之 前 规划 的 那样 。 

当 计算 ZMP 在 支撑 多 边 形 内 部 时 ， 就 保证 了 在 
单 边 约束 下 脚 和 地 面 的 完全 接触 ， 但 它 没有 告诉 我 们 
关于 控制 理论 范畴 中 稳定 性 的 任何 信息 。 

2. 全 三 维 动力 学 系统 的 计算 ZMP 

我 们 会 给 出 一 种 计算 机 器 人 的 计算 ZMP 的 方法 ， 
这 个 机 器 人 由 三 维 空间 内 的 w 个 刚体 连接 而 成 ( 见 
图 16. 13 ) 。 与 之 前 的 做 法 一 样 ， 我 们 假设 所 有 运动 
学 信息 (CoM 的 位 置 、 杆 件 的 姿态 、 杆 件 的 加 速度 
等 ) 已 经 由 正 运动 学 计算 得 出 。 在 这 一 小 节 中 ， 杆 
件 的 姿态 和 角速度 在 固定 于 地 面 的 坐标 系 中 表示 。 


图 16.13 机 器 人 模型 和 三 维 空间 
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首先 我 们 计算 总 的 质量 M 和 整个 机 器 人 的 质 
心 €: 
Mz S a (16. 27) 
c= Y mem 
SH, m A c 分 别 是 第 7 个 杆 件 的 质量 和 质心 。 


(16.28) 


(16.29) 
关于 原点 的 总 角 动 量 为 


Z= $ [c x (mc) + RLR o] (16.30) 


IP, R, LAM 分 别 是 3 x 3 的 旋转 矩阵 、 惯 性 张 
量 和 第 7 个 杆 件 的 角速度 。R,LR 给 出 了 固定 在 地 面 
坐标 系 下 的 惯性 张 量 。 
应 用 外 力 及 外 力矩 ， 线 性 动量 和 角 动 量 的 变化 用 

牛顿 欧 拉 定理 表示 为 : 
f=P -Mg 


(16.31) 


t-L-cxMg (16.32) 
aH, g=(0 0 -g] ， 是 重力 加 速度 向 量 。 
假设 外 力作 用 于 p 点 处 的 ZMP 
T=p Xf + Top (16. 33) 
IP, tase ZMP 处 的 力矩 ， 它 的 第 一 和 第 二 个 分 量 
将 式 (16.31) 和 式 (16.32) 式 代 入 式 (16. 33) 
得 到 


Tap =L -cx Mg & (P - Mg) xp (16.34) 
上 式 的 第 一 和 第 二 列 是 


To. =L, & Mgy Pp, - (P, - Mg)p, | (16.35) 
Topy =L , - Mgy - P,p, + (P, * Mg)p, — (16.36) 
其 中 我 们 使 用 如 下 符号 
Timp = [ Tzup i Tzwp Tzu, ] 
g- [P,P,P,]" 
Z=[L,L,L,]" 
c=[x y z]' 


零 力矩 点 可 通过 式 (16.35) 计算 得 到 ， 利 用 
Timp, = Tzmp,y =O 可 以 得 到 


Mex * pP, - L, 
Pe e y (16.37) 
Mg +P, 
Mgy + Pol, 
P ZEY TP, ty (16. 38) 


y 


Mg +P. 


SUP, p, 是 地 面 的 高 度 。 
当 机 器 人 保持 静止 时 ， 我 们 把 ZMP 当 作 CoM 的 
LR 
P, =x (16. 39) 
Psy (16. 40) 
注意 ZMP 也 可 以 从 拉 格 朗 日 形式 的 运动 方程 计算 得 
到 。 更 多 细节 参见 参考 文献 [163.2]. 


16.4.4 基于 ZMP 的 行走 步 态 生成 


1. 预定 脚印 与 ZMP 轨迹 

在 最 初 的 工作 中 ， 假 定 一 个 带 有 补偿 机 制 的 模型 
能 够 实现 预定 的 ZMP 轨迹 。 图 16. 14a 给 出 了 这 种 模 
型 的 一 个 实例 ， 它 预先 规划 腿 的 轨迹 ， 同 时 采用 补偿 
质量 控制 ZMP。 这 个 概念 由 Takanishi 和 Kato 人 研制 的 
WL-12 机 器 人 所 实现 ( 见 图 16. 14b) 69€. 


QYvo 


3 


PAESE: 


SLY 


预先 确定 的 
腿 的 运动 


a) 
Æ 16.14 带 有 补偿 质量 的 双 足 机 器 人 


在 现代 应 用 中 ， 机 器 人 身体 的 运动 用 来 实现 预定 
的 ZMP 轨迹 ， 如 图 16.15 所 示 。 预 定好 的 是 脚 的 轨 
迹 而 不 是 腿 部 关节 的 轨迹 。 腿 的 运动 是 由 身体 和 脚 的 
轨迹 经 过 道 运动 学 运算 决定 。 


身体 的 运动 由 ZMP 决 定 


图 16.15 当前 实际 应 用 的 ZMP 方案 
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图 16. 16 是 向 前 走 两 步 时 ZMP 轨迹 的 例子 。 
首先 ， 支撑 多 边 形 的 时 间 轮 廓 是 由 脚 的 轨迹 决定 ， 
如 图 中 的 灰色 区 域 所 示 。 它 的 宽度 由 脚 的 几何 形 
状 、 步 长 决定 ， 并 在 每 次 触 地 和 离 地 时 改变 到 其 
他 区 域 。 这 就 确保 了 ZMP 的 轨迹 ( 粗 体 的 线 ) 在 
支撑 多 边 形 的 内 部 。 只 要 ZMP 能 以 特定 的 稳定 域 
度 保 持 在 支撑 多 边 形 内 ， 我 们 就 可 以 设计 任意 的 
ZMP 轨迹 。 


行走 方向 
SS DS SS DS SS 


SS: 单 脚 支 撑 阶 段 
DS: 双 脚 支 撑 阶 段 


脚 落地 抬 脚 


脚 落 地 W 时 间 
图 16. 16 支撑 多 边 形 和 预定 ZMP 轨迹 。 


2. HE ZMP 的 步 态 生成 
我 们 定义 一 个 函数 ZMP ( )， 给 定 机 器 人 的 运 
动 ， 它 能 给 出 所 计算 的 ZMP, 


DEE 3 


RP, q, q 和 7 分 别 是 关节 位 置 、 速 度 和 加 速度 向 
量 。 基 于 ZMP 的 行走 步 态 生成 就 是 确定 一 个 恰当 的 
q(t) 满足 给 定 的 期 望 ZMP: pia) Alp! (0). mA 
意 以 下 几 点 : 

1) 这 个 方法 的 前 提 是 机 器 人 必须 完全 驱动 的 且 
是 位 置 控制 的 。 从 根本 上 说 ， 部 分 驱动 和 力矩 驱动 的 
机 器 人 不 适合 于 这 种 方法 。 

2) 当 g 的 维 数 大 于 3 时 ， 必 须 引 入 附加 的 约束 
来 消除 元 余 。 例 如 ， 常 常用 到 保持 身体 高 度 为 常数 和 
竖 直 的 约束 。 

3) 即使 在 适当 的 约束 下 ， 因 为 初始 条 件 g (0) 
是 自由 的 , R (16. 41) 有 无 穷 多 解 。 它 被 用 来 避免 
关节 轨迹 的 分 歧 。 

4) 实际 上 , 我 们 不 需要 确切 地 控制 ZMP 
p(t) =pi(t), p(t) =ps(1)。 尽 管 如 此 ， 在 行走 过 
程 中 最 好 令 ZMP 的 误差 和 最 小 。 


(16. 41) 


已 经 提出 了 一 些 实 用 的 方法 。Takanishi 等 提出 
使 用 傅 里 叶 变 换 解决 这 个 问题 ”| 。 通 过 对 ZMP S 
考 轨 迹 的 快速 傅 里 叶 变 换 (FFT) ，ZMP 方程 可 以 在 
频 域 内 求解 ， 然 后 再 经 逆 傅 里 时 变换 得 到 时 域 的 
CoM 轨迹 。Kagami 等 人 提出 了 在 离散 时 间 域 里 解决 
该 问题 的 一 种 方法 '“”。 他 们 认为 ZMP 方程 可 以 
离散 化 成 三 项 式 ， 并 且 对 于 大 小 为 的 给 定 参 考 
数据 ， 可 以 用 一 种 复杂 度 为 0 (N) 的 算法 有 效 

另外 一 种 实用 的 方法 由 Huang 等 人 提出 。Sugihara 
等 人 提出 了 一 种 方法 ， 这 种 方法 考虑 了 机 器 人 的 动力 
学 05521 S Nagasaka 等 人 提出 了 一 种 有 效 的 实时 方法 ， 
它 同 样 也 适用 于 跑 和 跳跃 的 运动 。Harada 等 人 提出 
了 另外 一 种 有 效 的 实时 方法 ， 可 以 应 用 于 边 走 边 推 一 
个 物体 的 运动 过 程 。 

3. 采用 预见 控制 器 的 行走 模式 生成 

本 节 我 们 会 介绍 由 Kajita 等 人 提出 的 方法 05371 。 
它 的 稳定 性 和 可 能 的 扩展 由 Wieber 做 了 深入 的 讨论 。 

为 简单 起 见 ， 我 们 再 用 图 16. 11 的 小 车 -桌子 模 
型 ， 此 时 我 们 把 小 车 的 颤动 作为 系统 的 输入 z 
x (16. 42) 
这 样 ，ZMP IE (16.25) 可 以 写成 一 个 严格 彻底 的 
动力 学 系统 ， 即 


* 0 1 0\(* 0 
f)%|=]0 0 1 x |+]0]u (16. 43) 
5 0 0 ol 1 


x 


x =U 


p= (1 0 -z/g)|x 


E 
对 于 这 个 系统 ， 我 们 可 以 设计 一 个 数字 控制 器 ， 它 可 
以 让 系统 的 输出 符合 参考 输入 ， 即 


u(k) --6X«0 - G x(k) (16.44) 
e(i) =p(i) -p° (i) 
shh, GÆ ZMP 跟踪 误差 的 增益 ; G, 是 状态 反馈 增 
益 , 并 且 x=[x x x 】。 第 大 个 采样 时 间 的 值 就 用 
大 代入 来 表示 。 反 馈 系 统 的 方 框图 如 图 16. 17 所 示 。 


图 16.17 ZMP 轨迹 控制 
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虽然 我 们 可 以 通过 LQ (线性 二 次 型 ) 反馈 增益 
保证 系统 的 稳定 性 , 但 是 由 于 相位 滞后 ， 式 
(16.44) 的 控制 器 不 能 实现 有 效 的 ZMP 跟踪 。 要 解 
决 这 个 问题 ， 我 们 必须 使 用 如 下 的 控制 器 


u(k) =~ G; Dei) -Ga( 人 -之 GO)P E+) 


(16. 45) 
第 三 项 是 新 增加 的 ， 并且 包 含 了 未 来 NN 个 采样 时 间 的 
ZMP 参考 。 因 为 这 个 控制 器 使 用 了 未 来 的 信息 ， 因 此 被 
称 为 预见 控制 器 ““” 。 增 益 GG) 称 为 预见 增益 ， 图 
16.18 给 出 了 它 的 未 来 曲线 。 我 们 可 以 观察 到 预见 增益 
很 快 就 消失 了 ， 这 样 就 可 以 忽略 远 处 的 参考 ZMP T. 
1500 


gg OO 
E: 


= 500 


0 02 04 06 08 10 12 14 16 
时 间 /s 


图 16. 18 ”预见 控制 器 增益 的 C。( 采样 时 间 t =5ms， 
Z, =0.814m, Q, 21.0, Q, =0, R =1.0 x1075) 


图 16. 19 给 出 了 一 个 用 预见 控制 器 生成 行走 模式 的 
例子 。 上 图 是 沿 着 x 轴 的 前 后 运动 ， 下 图 是 沿 y 轴 的 侧 
向 运动 。 我 们 看 到 生成 的 CoM 轨迹 (虚线) 是 光滑 的 ， 
结果 ZMP ( 粗 线 ) 也 很 好 地 跟踪 了 参考 (MR). 


0 1 2 3 4 6 7 
ZMP,/m 时 间 /s 
0.10 Pep a ZMP ref 

0.05 — ue 


6 7 
时 间 /s 
图 16. 19 预见 控制 的 身体 轨迹 ; 预见 周期 TV; =1. 6s 


16.4.5 基于 ZMP 的 行走 控制 
如 果 我 们 在 一 个 完美 的 平地 上 有 一 个 理想 的 机 


构 ， 就 可 以 期 望 这 个 机 器 人 通过 重 放 预 先 设 定好 的 关 

节 轨 迹 来 实现 行走 。 因 为 通常 不 是 这 种 情况 ， 所 以 我 

们 需要 使 用 传感器 信息 的 反馈 控制 来 改变 参考 轨迹 ， 

如 图 16. 20 所 示 。 其 中 的 稳定 器 在 参考 文献 【16. 25, 

47-50] 中 进行 了 讨论 。 
行走 模式 生成 器 


实际 机 器 人 


传感器 反馈 
图 16.20 步 态 生 成 器 和 稳定 器 


16.4.6 ZMP 概念 的 拓展 


当 观 察 到 CoM 的 投影 在 支撑 多 边 形 之 外 时 ， 我 们 
可 以 预测 这 个 机 器 人 会 摔 倒 。 但 是 ， 我 们 不 能 这 样 使 
用 ZMP， 因 为 ZMP 始终 不 会 离开 双 足 机 器 人 的 支撑 多 
边 形 。 当 ZMP 在 文 撑 多 边 形 的 边缘 时 ， 我 们 只 能 说 机 
器 人 可 能 摔 倒 ， 因 为 它 仅 是 摔 倒 的 必要 条 件 。 替 代 
ZMP 的 是 Goswami 所 提出 的 脚 旋转 指标 (FRI) 
FRI 是 通过 忽略 支撑 腿 加 速度 计算 得 到 的 ZMP， 并 且 
是 在 实际 机 器 人 上 可 以 测量 的 ， 它 可 以 超出 支撑 多 边 
形 的 范围 。 当 FRI 在 支撑 多 边 形 外 时 ， 说 明 有 一 个 文 
撑 腿 的 加 速度 ， 它 破坏 了 脚 与 地 面 的 接触 。 

另 一 个 问题 是 ZMP 是 仅 在 平面 上 定义 的 。Sar- 
dain 和 Bessonnet 论述 了 一 种 一 般 的 ZMP 计算 ， 它 包 
括 在 不 平整 路 面 上 的 双 脚 支撑 期 '“”|。 

Saida 等 人 提出 了 转 和 矩 的 可 行 解 方法 (FSW) 作 
为 有 腿 机 器 人 在 不 平整 路 面 上 的 新 准则 m3] 。 

Hirukawa 等 人 提出 了 一 个 通用 的 稳定 性 准则 ， 可 
以 处 理 任 意 几 何 形状 的 脚 与 地 面 的 接触 和 单 向 力 的 
za 


16.5 多 腿 机 器 人 


这 一 节 论 述 具 有 三 条 以 上 腿 的 机 器 人 。 
16.5.1 静态 步 态 的 分 析 

与 双 足 机 器 人 相 比 ， 多 腿 机 器 人 要 保持 静态 平 
衡 ， 其 脚 的 放置 有 更 多 的 选择 。 由 于 这 一 原因 ,， 已 经 
有 许多 研究 工作 汇聚 于 静态 稳定 的 步 态 规划 ， 而 非 动 
态 稳定 性 。 本 节 我 们 将 在 介绍 这 些 重要 结果 之 前 ， 介 
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ZH McGhee 51 、 Song 和 Waldron! ' °°! 的 成 果 。 

1. 稳定 裕 度 

在 多 腿 机 器 人 的 研究 中 ， 支 撑 模 式 这 个 术语 常用 
来 代替 支撑 多 边 形 "“””1。 通 过 忽略 身体 和 腿 部 加 
速度 所 引起 的 惯性 作用 ,我 们 可 以 保证 如 果 CoM 的 
投影 在 文 撑 模 式 内 ， 那 么 机 器 人 就 可 以 保持 平衡 ， 如 
图 16. 21 所 示 。 


支撑 多 边 形 
支撑 模式 
图 16.21 多 足 机 器 人 的 支撑 平面 (支撑 模式 ) 

对 一 个 给 定 构 型 的 行走 机 器 人 ， 稳 定 裕 度 Sn 定 
义 为 CoM 的 垂直 投影 与 水 平面 上 的 支撑 模式 边界 的 
最 小 距离 ， 如 图 16. 22a 所 示 。 此 外 ， 还 提出 了 男 一 
个 指标 来 解析 地 求解 最 优 步 态 。 那 就 是 水 平稳 定 裕 度 
Si ， 它 被 定义 为 Com 的 垂直 投影 与 支撑 模式 边界 在 
平行 于 身体 运动 方向 的 最 小 距离 。 


Sm = min (di, do, d3) S -—ná (di; d 
a) b) 
图 16.22 稳定 裕 度 的 定义 
a) 稳定 裕 度 b) 水 平稳 定 裕 度 


2. 四 足 怜 行 和 蠕动 步 态 

对 于 前 后 共有 2n 条 腿 的 机 器 人 或 者 动物 ， 我 们 
分 别 用 奇数 1，3 ，…，2n -1 来 索引 左边 的 腿 ， 用 偶 
Z2, 4, 0, 2n 索引 右边 的 腿 。 根 据 这 个 规则 ， 四 
足 机 器 人 的 腿 就 被 编 了 号 ， 如 图 16. 23 所 示 。 


图 16. 23 四 足 机 器 人 的 腿 编号 


为 了 保持 静态 稳定 的 行走 ， 四 足 机 器 人 必须 在 每 
一 步 只 抬 起 和 放下 一 条 腿 。 一 般 来 说 ， 这 样 的 模式 叫 
做 疏 行 步 态 。 四 足 机 器 人 所 有 可 能 的 爬行 步 态 可 以 用 
代表 脚 着 地 次 序 的 腿 编号 序列 来 表示 。 通 常 选 腿 1 作 
为 第 一 个 摆动 腿 ， 我 们 可 以 得 到 (4 -1)! =6 种 不 
同 的 步 态 ， 如 图 16. 24 所 示 。 


3 1 3 1 
. . | [ 
b) c) 

3 1 3 1 
p : l [ 
e) f) 


图 16. 24 四 足 的 爬行 步 态 


a) 1243 b) 1423 c) 1234 d) 1342 
e) 1324 f) 1432 


2 
d) 


接 下 来 我 们 会 看 到 ，1423 ( 见 图 16.24b) HYE F 
步 态 在 沿 x 方向 行走 具有 最 大 的 稳定 性 ， 被 称 作 蠕 动 
步 态 。 注 意 ， 如 果 行 走 的 方向 是 -x，1324 (图 
16. 24e) 也 是 蠕动 步 态 。 同 样 ，1234 ( 见 图 16.24c) 
和 1432 (ILEI 16. 24f) 就 是 -y 和 y 方 向 的 蠕动 步 态 。 

另 一 方面 ，1243 和 1342 B9 f8 f; 2b ds (LA 


16.24a 和 图 16.24d) 具有 中 等 稳定 性 ， 且 适合 于 
转动 。 
3. HEA 


图 16. 25b 是 描述 多 腿 机 器 人 步 态 序列 的 步 态 图 。 
水 平 轴 代 表 由 行走 周期 了 归 一 化 后 的 时 间 坐 标 。 线 段 
部 分 对 应 每 条 腿 的 着 地 到 离 地 的 过 程 。 因 此 线段 的 长 
度 表示 支持 阶段 。 从 这 个 图 我 们 可 以 定义 腿 i 的 占 空 
比 B, 和 相位 Q, 


p,- Ric TE 
g, Bi sunt (ig 
MAS 
Bi 
1-————_1 
Bs 

3L $5 5: 

RA — 

0 1 

a) b) 归 一 化 时 间 


图 16.25 步 态 图 与 参数 
a) 腿 的 编号 b) 步 态 图 和 参数 
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腿 i 着 地 的 时 间 从 腿 1 着 地 的 时 间 开 始 测 量 ， 因 
此 对 任何 步 态 有 p, =0。 

4. 四 足 机 器 人 的 波形 步 态 

对 于 四 足 机 器 人 ， 存 在 一 种 具有 最 大 稳定 裕 度 的 


BEAST ， 它 被 称 为 波形 步 态 ， 定 义 如 下 : 
B;=B, (i=1,.…,4) (16. 48) 
0.75«B «1 (16. 49) 
$, 20.5 (16. 50) 
$, -B (16.51) 
p, 24, -0.5 (16. 52) 


其 中 B 是 波形 步 态 的 占 空 比 。 图 16.26 给 出 了 B= 
0.75 时 波形 步 态 的 步 态 图 。 
腿 编号 


0 1/4 1/2 3/4 1 

归 一 化 时 间 

图 16.26 四 腿 机 器 人 的 波形 步 态 
(B =0.75) 


观察 图 16. 26 中 腿 着 地 的 顺序 ， 它 就 是 图 16. 24b 
PRIETA (1423 ) 。 因 此 ， 波 形 步 态 是 最 优 的 疏 
行 步 态 。 
波形 步 态 最 重要 的 特征 是 式 (16.51)。 也 就 是 
说 腿 3 在 腿 1 离 地 时 着 地 ， 由 图 16.26 中 的 椭圆 
(虚线 ) 表示 。 式 (16.49) 给 出 了 静态 行走 的 占 空 
比 的 可 能 范围 。 此 外 ,波形 步 态 还 具有 有 序 和 对 称 
的 特征 。 当 所 有 腿 具 有 相同 的 工作 系数 B 时 ， 步 态 
就 是 有 序 的 ， 可 以 由 式 (16.48) 进行 验证 。 当 每 
一 列 的 左 脚 和 右 脚 的 相位 是 半 周 期 时 ， 步 态 就 是 对 
称 的 ， 可 以 由 式 (16.50) 和 式 (16.52) 进行 
验证 。 
5. 2n 腿 机 器 人 的 波形 步 态 
一 个 具有 2n 条 腿 的 机 器 人 的 波形 步 态 可 以 定义 
为 有 序 和 对 称 的 步 态 ， 它 具有 以 下 的 特征 。 
Panai 2 F(mB),(mz1,,n-1) (16.53) 
3/(2n) «B «1 (16. 54) 
XB, F (x) 是 实数 x 的 分 数 部 分 。 方 程 (16.53) 
是 式 (16.51) 的 一 个 概括 。 多 腿 机 器 人 波形 步 态 的 
例子 见 图 16.27, WE (虚线 ) 是 其 条 件 〈 见 式 
(16.53) ) 。 
图 16.28 是 当 B = 1/2 时 的 波形 步 态 ， 它 对 多 腿 


Ly 


6 4 2. 0 1/6 2/6 3/6 4/6 5/6 1 
a) b) 归 一 化 时 间 

图 16. 27 六 腿 机 器 人 的 波形 步 态 

a) 腿 的 编号 b) 波形 步 态 (6 =28 ) 


机 器 人 是 最 重要 的 。 从 式 (16.54) 中 的 约束 可 知 ， 
这 是 多 腿 机 器 人 最 小 的 占 空 比 ， 所 以 产生 了 最 快 的 行 
走 步 态 。 这 个 特殊 步 态 被 称 为 三 角 步 态 ， 因 为 机 器 人 
是 由 三 条 腿 145 和 236 所 分 别 支撑 的 。 


腿 编 号 


Qv 4 tat — 


0 1⁄6 2/6 3/6 4/6 5/6 1 4 
a) 归 一 化 时 间 b) 


图 16.28 六 腿 机 器 人 的 三 角 腿 步 态 
a) 波形 步 态 (B=1/2) b) 支撑 模式 (1 =1/6) 


我 们 已 经 知道 2n 腿 机 器 人 具有 最 大 水 平 态 稳定 
裕 度 的 是 波形 步 态 ““ 。 图 16. 29 给 出 了 最 优 的 波 
形 步 态 的 稳定 裕 度 ， 对 有 N 条 腿 机 器 人 ， 它 是 用 身 
RANK BE L, ( 见 图 16.27a) 进行 归 一 化 的 六 5 。 
我 们 可 以 观察 到 随 着 腿 数目 的 增加 ， 稳 定性 和 占 空 
因数 的 范围 都 增 大 了 。 最 大 值 是 N=4 ~6， 增 大 量 
随 着 N = o 逐渐 变 小 。 因 为 硬件 的 价格 与 腿 的 数目 
成 正比 ， 这 就 解释 了 为 什么 多 于 10 条 腿 的 机 器 人 很 


少见 。 


0 0.2 0.4 0.6 0.8 


1 
占 空 因数 
图 16.29 WN 腿 运 动 系统 的 最 优 的 波形 步 态 稳定 域 度 
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E " 加 在 操作 机 构 上 的 负载 就 会 大 大 减 小 。 用 这 种 方式 ， 
16.5.2 实用 的 步 态 设计 在 不 同 路 面 上 行走 时 操作 者 的 负担 会 急剧 减 小 。 根 据 
与 此 前 的 理想 分 析 不 同 ， 实 际 的 有 腿 机 器 人 是 很 ”地 面 的 不 平坦 程度 ， 能 量 消耗 和 身体 运动 的 平稳 性 ， 
复杂 的 。 本 节 我 们 会 精 选 一 些 最 新 的 机 器 人 实例 ， 从 8 16.2 中 所 列 出 的 每 种 步 态 都 有 其 各 自 的 优势 
中 了 解 更 实际 的 步 态 控制 。 表 16.2 ASV 所 使 用 的 步 态 5 
1. Hexapod: 自 适应 悬 架 车 


图 16. 30 是 最 著名 的 六 足 机 器 人 之 一 ， 由 Wal- 
dron 和 McGhee 研制 的 自 适应 悬 架 车 (ASV), ASV 等 相位 步 态 
是 由 液压 驱 动 的 多 腿 机 器 人 ， 它 可 以 在 不 平坦 的 地 面 反 向 波形 步 态 
上 承载 一 个 人 。 表 16. 1 列举 了 其 设计 特点 和 在 自然 PANE 反 向 等 相位 步 态 
地 面 实验 时 ASV 的 移动 性 能 。 灵巧 周期 性 步 态 


连续 的 先导 跟随 步 态 
离散 的 先导 跟随 步 态 
大 障碍 步 态 
精确 着 地 步 态 
自由 步 态 


2. 四 腿 机 器 人 : TITAN 系列 
图 16. 31 是 由 Hirose 与 他 的 同事 所 研制 的 四 腿 
PLA ATS] TITAN M ( 见 图 16.31a) 有 四 条 
退 ， 每 一 条 长 1. 2m， 质 量 80kg。 每 一 条 腿 都 有 三 个 
直流 电动 机 驱动 ， 这 样 ， 它 就 是 一 个 12 个 自由 度 的 
行走 机 器 人 。 在 平地 上 ，TITAN M — fp 3538 Ye 
316.1 自 适 应 悬挂 车 的 特点 D659 行 步 态 ， 这 种 步 态 能 使 他 在 各 个 方向 上 都 能 够 移动 
(EHE YT EAE AS). “EGE BIS ANF K e k 
时 ， 它 就 用 自由 步 态 ， 这 种 步 态 是 寻找 落脚 点 的 非 
周期 步 态 ， 可 以 避免 障碍 和 保持 静态 稳定 性 。 图 
16.32 给 出 了 一 个 自由 步 态 过 河 的 例子 。 机 器 人 一 
自由 度 / 个 18 (3x6) [n J uh, CMRE UW ET GE EAS, PLEAS 
质量 /kg 2700 会 更 有 效 。 
载荷 /kg 220 


图 16. 30 自 适 应 悬 架 车 (1986) 6%! 


速度 /(km/h) 8 


MOB HE 60% 坡度 


移动 能 力 /m 


表 16.2 给 出 了 用 来 控制 ASV 的 各 种 步 态 。 我 们 


图 16. 31 TITAN 系列 


刻 的 能 量 消耗 会 出 现 峰值 。 等 相位 步 态 解决 了 这 个 问 
题 。 另 外 一 种 有 趣 的 步 态 是 先导 跟随 步 态 ， 在 这 种 步 TITAN V ( 见 图 16.31b) 具有 一 个 和 TITAN M 
态 中 ， 中 间 脚 落 在 前 脚 的 脚印 上 ， 后 脚 落 在 中 间 脚 的 ”一样 的 结构 ， 但 重 达 160kg。 因 为 它 有 更 强大 的 电动 


却 印 上 。 用 这 种 步 态 在 很 不 平坦 的 地 面 上 行走 时 , 施 机， 可 以 完成 动态 行走 。 如 果 摆 动 腿 U 有 一 个 给 定 
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图 16.32 跨 过 河流 的 行走 运动 69 


的 回收 速度 ， 那 么 占 空 


HEX B 的 行走 速度 就 是 
geass 
B 
对 静态 稳定 的 波形 步 态 , B 的 最 小 值 是 0.75， 这 样 
V=0.33U 就 是 最 / 小 速度 。 但 是 ， 如 果 占 空 比 B = 
0.5, J V=U， 这 是 静态 行走 最 大 速度 
的 三 倍 。 图 16.33 就 是 这 样 的 步 态 。 步 态 图 (图 
16. 33) 是 机 器 人 在 所 有 的 时 间 里 都 是 两 条 SERUUM 

这 被 称 为 小 跑步 态 。 


(16. 55) 


服 编号 
i A 
3 上- 一 
2 L—————3 1 
4 E 
0 1/4 1/2 3/4 
eui as 
a) b) 


图 16.33 小 跑步 态 
a) 步 态 图 b) 支撑 模式 


如 图 16. 33b 所 示 ， 小 跑步 态 是 一 种 ZMP 控制 在 
支撑 模式 内 部 而 CoM 的 投影 在 其 外 部 的 动态 行走 。 
Hirose 等 人 引入 了 身体 摆动 控制 来 实现 ZMP 的 条 件 ， 
并 且 将 扩张 小 跑步 态 从 低速 静态 步 态 很 平滑 地 过 滤 到 
高 速 的 动态 步 态 “中 puse, TITAN IV 的 继承 者 TI- 
TAN VI 也 采用 了 这 种 技术 "1。 


16. 5.3” 受 哺乳 动物 启发 的 动态 四 足 机 器 人 


自然 界 存在 许多 腿 式 运动 ， 其 中 一 些 比 此 前 所 讨 
论 的 机 器 人 具有 更 强 的 动态 性 。 图 16. 34 给 出 了 两 个 
甫 乳 动 物 的 动态 步 态 '“"1 。 例 如 骆驼 的 跤 步 ， 奔 跑 
的 狗 的 跳跃 动作 。 
Raibert 证 明了 通过 对 角 的 腿 、 前 后 腿 和 左右 腿 的 
成 对 运动 实现 的 小 跑 、 跤 步 和 跳跃 可 以 被 看 做 是 具 


= 


X i9 


4 1=3/4 2 t=1/4 
腿 编 号 
1 1 
3 3 r—4 
2 m 2 
4 e 4 
1⁄4 1/2 3/4 1 0 1/4 102 3/4 1 
归 一 化 时 间 归 一 化 时 间 
a) b) 


图 16.34 四 足 动 物 的 其 他 动态 步 态 
a) WP b) 跳跃 


偶数 条 腿 动物 的 双 足 运动 。 用 这 一 观点 ， 他 展示 了 一 
个 液压 驱动 的 四 足 机 器 人 ， 可 以 完成 小 跑 、 踊 步 和 跳 
跃 !“ 引 。 这 样 的 步 态 也 被 电动 的 机 器 人 以 不 同 的 控制 
策略 实现 了 "| 。 

图 16. 35a 是 最 近 研 发 的 像 哺乳 动物 的 四 足 机 器 
Ao Tekken 是 一 个 电动 四 足 机 器 人 ， 它 身体 长 20cm， 
质量 为 3. 1kg， 是 由 Fukuoka 和 Kimura 研发 的 所。 
使 用 基于 中 枢 模式 发 生 器 (CPG) 和 反射 控制 ， 它 可 
以 在 不 规则 的 地 面 上 行走 。 
能 量 自给 的 液压 四 足 机 器 人 ， 它 
长 Im， 质量 为 90kg， 由 Buehler 等 人 研发 
(ILEI 16.35b)。 其 每 条 腿 有 一 个 被 动 直 线 气动 柔顺 


BigDog 是 一 台 


高 lm, 


Be ELEY BB SRSA. ADEA BTA AO UR — FE He 
。 在 户外 环境 下 ，BigDog 可 以 在 35° 的 斜坡 上 
行走 ， 也 可 以 以 0. 8m/s 的 速度 小 跑 ， 可 以 携带 50kg 
的 负载 。 


age. 63] 


b) 
图 16.35 受 哺乳 动物 启发 的 四 足 机 器 人 11 on 


a) Tekken (2003) b) BigDog (2005) 


16.5.4 ”基于 行为 的 多 腿 机 器 人 


图 16. 36a 是 一 个 小 型 六 足 腿 机 器 人 Genghis 
(长 3Scm， 质 量 为 1kg) ， 由 Brooks WEUS S E 
要 的 是 ，Genghis 的 步 态 不 是 显 式 控制 的 ， 而 是 由 


304 第 2 篇 


机 器 人 结构 


一 种 叫做 分 类 体系 的 网 络 经 过 仔细 设计 而 形成 的 。 
Genghis 和 其 他 一 些 Brooks 的 机 器 人 在 机 器 人 和 人 
工 智 能 领域 创造 了 一 股 强 劲 的 基于 行为 的 机 器 人 
的 潮流 。 

图 16. 36b 是 八条 腿 的 机 器 人 SCORPION (长 
65cm， 质 量 为 11. 5kg) ， 它 由 不 莱 梅 大 学 和 国家 宇航 
局 (NASA) 合作 研制 $1。SCORPION 的 步 态 控制 
是 在 行为 网 络 和 中 枢 模 式 发 生 器 的 基础 上 进行 设 
计 的 。 


图 16.36 生物 启发 的 多 腿 机 器 人 Uo 0) 
a) Genghis (1989) b) SCORPION (2004) 


16.6 ”其 他 的 有 腿 机 器 人 


16.6.1 腿 - 轮 混合 机 器 人 


与 动物 和 昆虫 不 同 ， 机 器 人 可 以 装 有 可 无 限 旋转 
的 轮子 。 通 过 将 轮子 的 效率 和 腿 的 灵活 性 相 结 合 ， 
以 期 待机 器 人 以 最 小 的 能 耗 获得 对 地 面 的 最 大 适应 
性 。 图 16. 37 就 是 一 个 这 样 的 例子 。 


图 16.37 腿 - 轮 混合 机 器 人 


a) 腿 -轮机 器 人 怜 台阶 (1998) b) Roller Walker (1996) 
c) RHex (2001) d) Whegs II (2003) 


图 16. 37a Z&—-lR- SE Ld AIR 8 BER PIT, rH 
Matsumoto @ ADEA 679, qz J& —^- E E f BE 
面 机 器 人 ， 但 是 每 个 腿 的 末端 都 装 有 动力 轮 。 在 单 腿 
支撑 阶段 ， 机 器 人 就 像 轮 式 倒立 摆 一 样 被 控制 。 此 
外 ， 他 们 还 研发 了 一 种 控制 器 来 实现 从 单 腿 支撑 到 双 
腿 支 撑 的 平缓 转换 。 

图 16.37b 是 RollerWalker， 由 Hirose 等 人 研 
BVM) RollWalker 是 12 个 自由 度 的 四 足 机 器 
人 ,在 脚尖 装 有 被 动 轮 。 它 在 平地 上 使 用 转动 请 行 
模式 ， 在 不 平坦 的 地 面 上 可 以 通过 被 动 轮 的 反作用 
行走 。 

图 16. 37c 是 Buehler 等 人 研发 的 RHex。 虽 然 它 
最 初 是 受 螃 螂 运动 的 启发 ， 但 RHex 仅 有 6 个 主动 的 
自由 度 ， 即 每 个 髋 一 个 。 此 外 ， 它 的 腿 可 以 绕 轴 旋转 
完整 的 一 圈 。 使 用 这 种 独特 的 设计 ，RHex 可 以 在 不 
平整 、 有 障碍 的 地 面 上 行走 和 跑步 。 最 近 ， 它 还 展示 
了 使 用 甚 后 腿 可 以 实现 双 足 跑步 (71 , 

图 16. 37d 是 Whegs 开 ， 它 是 另 一 个 由 Allen 等 人 
受 蜂 螂 启发 研制 的 机 器 人 '*” 引 。 这 个 机 器 人 只 有 4 
个 主动 的 自由 度 , 一 个 用 来 推进 ， 另 外 两 个 用 来 控制 
方向 ， 还 有 一 个 用 来 实现 身体 的 弯曲 。 每 一 条 腿 都 有 
3 个 带 弹 簧 的 辐 ， 并 且 是 由 同一 个 驱动 器 驱动 的 。 与 
RHex 相 比 ，Whegs 工 的 可 变性 更 强 ， 而 使 用 的 驱动 
fit ED 


16.6.2 腿 - 辟 混合 机 器 人 


男 一 个 设计 理念 是 腿 - 臂 混合 机 右 人 。 既 然 腿 固 
有 许多 自由 度 ， 那 么 就 可 以 将 它们 当 作 操 作 臂 使 用 。 
通过 这 种 方法 ， 我 们 可 以 把 总 的 自由 度 降 到 最 少 ， 并 
且 它 的 复杂 性 、 质 量 和 能 量 都 降 到 最 小 。MELMAN- 
TIS-1 〈 见 图 16.38a) 是 由 Koyachi 等 人 研发 的 六 足 
HLA, EA 22 个 自由 度 ， 因 此 可 以 将 它 的 腿 转换 
成 操作 臂 '“。 这 个 机 器 人 可 以 用 两 条 腿 操 作 一 个 
物体 ， 而 另外 四 条 腿 站 在 地 上 ， 在 用 六 条 腿 行走 时 能 
达到 最 大 的 稳定 性 。 

Yanbo3 是 8 “+A AREAS SUE SLA A, © H Yone- 
da 和 Hirose 研发 下 。 对 双 足 机 器 人 和 操作 机 构 来 
说 ， 它 的 设计 使 得 它 在 单 腿 支 撑 时 具有 最 少 的 自由 
度 。 图 16. 38b 中 ， 它 正 用 它 的 脚 按 电梯 按钮 。 


16.6.3 绳索 行走 机 器 人 


16.39 是 Dante I, — & / BR AR ZR LARA, FA 
CMU 场地 机 器 人 研究 中 心 于 1994 年 研发 。 它 在 阿拉 
斯 加 的 火山 里 被 用 做 科学 研究 。 为 了 在 非常 陡峭 的 火 
山洞 壁 上 像 登 山 者 那样 攀 疏 下 降 ， 这 个 机 器 人 将 一 条 
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图 16. 38 腿 - 臂 混合 机 器 人 
a) MELMANTIS-1 (1996) b) Yanbo3 (2003) 


E] 16.39 Dantell (1994) 067] 


绳索 系 在 火山 洞口 5 。Hirose 等 人 也 发 明了 一 种 用 
于 建筑 的 绳索 四 足 机 器 人 。 


16.6.4 GBA 


CE La A BU EE CE BADE) BLA A) im 
重要 的 部 分 是 能 产生 成 拉力 的 脚 机 构 ， 抽 真空 后 的 杯 
子 、 电 磁铁 (金属 墙壁 ) 、 黏 性 材料 以 及 微 刺 阵列 都 
被 采用 过 。 

图 16. 40a NCEE Vu fe Las A NINJA- 1, Hi Hirose 
SEWER ”。 它 的 每 只 脚 都 有 特别 设计 的 抽 真 空 
垫子 ， 这 样 可 以 减少 空气 的 泄漏 。 另 一 个 装 有 抽 真 空 
吸盘 的 可 靠 的 仆 壁 机 器 人 由 Yano FAWR 
图 16. 40b 是 六 足 扑 壁 机 器 人 RISE, FH Kim 等 人 
研发 ”31 。 每 一 只 脚 都 有 微 刺 阵列 ， 这 是 从 一 些 
昆虫 和 蜂 蛛 中 观察 得 来 的 。 它 可 很 好 地 在 多 种 户外 地 
ME, GEE, KEMA. 


图 16.40  fEREJLAR A [16 9801 


a) NINJA-1 (1991) b) RiSE (2005) 


16.7 性 能 指标 


本 节 我 们 介绍 一 些 有 用 的 性 能 指标 ， 可 以 用 来 评 
价 具 有 不 同 结构 的 机 器 人 。 


16.7.1 稳定 裕 度 概念 的 拓展 


如 16.5.1 中 所 述 , 稳定 性 裕 度 由 McGhee 和 
Frank 最 早 提出 来 用 于 描述 多 腿 机 器 人 事态 行走 稳定 
性 的 程度 '*”]。 对 一 个 动态 行走 机 器 人 ， 因 为 ZMP 
是 CoM 在 地 面 投影 上 的 自然 延伸 ， 所 以 我 们 可 以 定 
义 稳 定性 裕 度 为 ZMP 到 支撑 多 边 形 的 最 小 距离 。 这 
个 事实 已 经 在 此 前 ZMP PE a dug 
经 被 许多 人 使 用 过 。 例 如 明确 定义 的 ZMP 稳定 性 裕 
度 可 以 参见 Huang AREA 。 

一 个 有 腿 机 器 人 行走 在 不 平坦 的 地 面 上 ， 
Messuri 和 Klein 把 能 量 稳定 裕 度 定义 为 使 机 器 人 跌倒 
所 需 的 最 小 能 量 

S, = min( Mgh;) (16. 56) 
SUP, hh, 是 在 多 边 形 第 i 个 断面 周围 跌倒 的 CG 高 度 
变化 ，M 是 机 器 人 的 总 质量 下 。 这 个 概念 已 被 广 
泛 接受 ， 而 且 还 有 一 些 改进 的 提议 。 


16.7.2 占 空 比 和 弗 劳 德 数 


在 这 一 章 中 ， 我 们 已 经 看 到 多 种 可 以 适应 某 些 环 
境 和 假设 的 机 器 人 。 但 是 在 一 些 例子 中 ， 我 们 必须 用 
一 些 性 能 指标 比较 不 同 质量 、 不 同 大 小 、 不 同 腿 数目 
的 机 器 人 。 这 样 的 指标 必须 是 无 量 纲 的 ， 就 像 流 体力 
学 中 的 Mach 和 Reynolds 指数 。 
已 经 存在 一 个 对 行走 机 器 人 有 用 的 指标 ， 即 占 空 
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比 B， 它 被 定义 为 


XE 
B= -冰期 


占 空 比 可 以 用 来 区 别 走 和 跑 ， 因 为 当 B>=>0.5 时 是 走 ， 


mi g <0. 5 时 是 跑步 ! 


16.67] 
o 


弗 劳 德 数 在 流体 力学 中 


于 描述 表面 波 的 特性 。 


因为 表面 波 和 腿 的 运动 都 是 重力 场 下 的 动态 运动 ， 


Alexander 就 
计算 弗 劳 德 数 


用 它 描述 动物 的 运动 ”1 。 他 用 下 式 


16.7.3 阻力 系数 


阻力 系数 是 另 一 个 重要 的 无 量 纲 数 ， 它 用 来 评价 

一 个 移动 机 器 人 的 能 量 效率 。Gabrielli 和 von Karman 
用 单位 距离 的 能 耗 讨论 了 各 种 机 动车 的 性 能 。 即 

E 

~ Mad 


(16. 59) 


€ 


(16.57) 


式 中 , V 是 行走 或 者 跑步 的 速度 ; g 是 重力 加 速度 ; 


式 中 , E 是 行走 距离 d 的 总 能 耗 ; M 是 机 动车 的 总 
质量 ; e 是 重力 加 速度 "8 。 注 意 到 ， 当 我 们 把 
一 个 质量 为 M 的 箱子 在 摩擦 系数 为 4 的 地 上 推动 
距离 d 时 ， 消 耗 的 能 量 是 Weuwd， 阻 力 系数 就 变 成 
2 = 人 。 因 此 我 们 可 以 认为 电阻 率 说 明 的 是 运动 的 


六 是 艇 距离 地 面 的 高 度 。 他 证 明了 不 同 大 小 的 动物 的 Spam 
弗 劳 德 数 一 样 时 ， 其 步 态 也 是 一 样 的 。 特 别 地 ， 多 数 在 Gabrielli 和 von Karman 早期 的 工作 中 ， 它 们 在 
动物 在 速度 相当 于 弗 劳 德 数 Fa = 工时 ， 步 态 就 从 行 各 种 机 动车 辆 上 面 出 了 阻力 系数 对 速度 的 函数 图 ， 即 
走 变 成 了 跑步 。 图 16.41。 这 被 称 为 Gabrielli- von Karman 图 ， 并 且 被 
弗 劳 德 数 也 可 以 定义 为 Umetani 和 Hirose 用 于 比较 不 同方 式 的 运动 3， 
F, = Vy (16. 58) Gregorio, Ahmadi 和 Buehler tH HEHH T £7 3E BL28 A RJ 
veh 阻力 系数 ， 这 些 机 器 人 包括 他 们 的 弹跳 机 器 人 ，ARL 
它 是 的 ,的 平方 根 ， 可 以 作为 动物 或 者 有 腿 机 器 人 Mog LR A UE 。 
的 无 量 纲 速度 。 
100 
OSU hexapod [16] 
10 N Hydraulic quadruped 
BS [5D 
e PV IL [14] 
Electric monopod 
Big muskie [15] @ d ndr MENT roads 
e ASV [17] 
1 © Helios IT [18] 
ES ARL monopod [fig. 8] 
RE ° 1950 Cars [13] 
R 
Ei Human running [23] ^ a 
1994 Cars [21] ^ 
0.1 Off-road 7 
Human ^ 
walking [23] Pd 
Gravity walker 7 
(McGeer [20]) 7 
Human ^ Limiting line 
0.01 cycling [23] = ^ — — (Gabrielli-& von-Karman [13]) 


0.001 


0.01 0.1 1 10 
速度 /(m/s) 


图 16.41 Gabrielli- von Karman 图 U9 8] 
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16.8 


结论 与 未 来 发 展 趋势 


这 一 章 ， 我们 讨论 了 如 下 话题 。 


1 
历史 。 
1 


6.1 节 发 展 简 史 : 介绍 了 研究 有 腿 机 器 人 的 


6.2 节 周期 性 行走 的 分 析 : 作为 典型 的 周期 


性 行走 机 器 人 ， 分 析 了 一 个 简单 的 被 动机 噩 人 。 庞 加 


ARI 
1 


时 是 重要 的 分 析 工具 之 一 。 
63 5 用 正 动力 学 控制 双 足 机 器 人 : 讨论 了 


双 足 机 器 人 的 动力 学 与 控制 。 单 边 地 面 力 的 处 理 是 双 
足 行走 的 关键 问题 ， 也 是 其 他 有 腿 机 器 人 的 关键 


问题 。 
1 


6.4 节 RH ZMP 方法 的 双 足 机 器 人 : 讨论 了 


实际 控制 双 足 机 器 人 的 方法 ， 零 力矩 点 (ZMP) 。 


1 
关系 。 


1 
昆 合 、 


ae 


只 是 冰山 的 一 角 。 


1 


6.5 节 多 腿 机 器 人 : 讨论 了 步 态 和 稳定 性 的 
此 外 ， 介 绍 了 这 一 领域 的 代表 机 器 人 。 

6.6 节 其 他 的 有 腿 机 器 人 : 我 们 介绍 了 腿 - 轮 
腿 - 臂 混合 、 强 索 行 走 和 疏 墙 机 器 人 。 读 者 可 
里 所 展现 的 想象 力 印象 深刻 ， 但 是 这 些 例 子 


d BS dii 
p FF es 


6.705 性 能 指标 : 讨论 了 稳定 裕 度 ， 


数 和 阻力 系数 。 它 们 是 比较 具有 不 同 结构 的 机 器 人 的 


性 能 指标 。 


在 过 去 的 三 十 匀 


， 有 腿 机 器 人 已 经 变 得 更 快速 、 


"m 


更 高 效 和 更 稳定 了 。 这 种 趋势 在 未 来 仍 会 继续 ， 最 终 
的 目标 是 拥有 和 昆虫 、 哺 乳 动 物 甚 至 我 们 人 类 自己 相 
媲美 的 运动 。 
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本 章 介绍 、 分 析 和 比较 几 种 轮 式 驱动 移动 机 器 
人 (WMR) 的 模型 ， 并 给 出 此 类 机 器 人 的 几 种 实 
现 方法 和 常见 的 设计 。 

对 于 轮 式 移动 机 带 人 (WMR)， 其 车 轮 与 运动 
平面 之 间 的 纯 滚动 条 件 产生 运动 学 约束 ， 因 此 ， 在 
基于 这 种 运动 学 约束 的 基础 上 ， 我 们 对 其 移动 性 进 
行 了 讨论 。 相 关 讨 论 表 明 : 无 论 WMR 的 轮子 的 数 
目 是 多 少 个 ,无 论 其 轮子 类 型 有 多 少 种 ， 在 总 体 
上 ， 所 有 的 WMR 都 属于 五 大 类 。 

另外 ， 本 章 还 对 不 同类 型 的 轮 式 移动 机 器 人 的 
数学 模型 进行 了 推导 和 上 比较， 例如: 姿态 模型 和 结 
构 模 型 、 运 动 学 模型 和 动力 学 模型 、 并 讨论 和 比较 
了 这 些 模型 的 结构 特性 。 

轮 式 移动 机 器 人 的 数学 模型 及 其 性 质 构 成 了 基 
于 模型 的 控制 方法 设计 的 必要 基础 。 根 据 驱 动 轮 的 
数目 ， 我 们 对 实际 机 器 人 的 结构 做 了 分 类 ， 分 别 介 
绍 了 各 类 的 特点 ， 并 对 某 些 被 广泛 采用 的 设计 做 了 
重点 说 明 。 尤 其 是 对 于 全 方位 移动 机 器 人 以 及 多 关 
节 型 机 器 人 ， 进 行 了 更 详细 的 描述 。 


17. 1 概述 ed ee ee 310 
17.2 轮 式 机 器 人 的 移动 性 ………… cece ee eees 311 
17.2.1 £&t Fg. 311 
17.2.2 运动 学 约束 RS 312 


17.1 概述 


本 章 旨 在 对 轮 式 移动 机 器 人 进行 一 般 性 的 描述 ， 


并 且 从 考虑 移动 性 的 角度 出 发 ， 讨 论 各 种 轮 式 移动 机 
器 人 的 性 质 ， 同 时 介绍 几 种 基于 模型 的 控制 律 的 设计 
中 所 需 的 动力 学 模型 ， 并 说 明 这 类 机 器 人 最 常见 的 实 


现 方法 。 


个 运动 学 约束 ， 也 就 是 轮子 和 地 面 在 每 一 个 接触 点 
仪 产生 纯 滚 动 ， 而 没有 打滑 。 此 假设 意味 着 轮子 与 
地 面 的 接触 力 的 大 小 恰好 满足 纯 滚 动 运动 的 条 件 。 


本 章 中 我 们 假设 轮 式 移动 机 器 人 的 轮子 满足 一 


详 
17.2.3 机 器 人 的 结构 变量 …………………… 314 
17.2.4 机 器 人 移动 性 的 约束 ………………… 314 
17.2.5 机 器 人 移动 性 的 描述 ……………… 315 
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根据 现象 学 接触 力 模型 可 知 ， 这 种 接触 力 可 以 看 做 
由 轮子 和 地 面 之 间 的 局 部 滑动 所 产生 的 ， 事 实 上 ， 
这 仅仅 是 一 种 理想 模型 。 运 用 奇异 摄 动 方法 ， 我 们 
可 以 看 出 这 种 滑动 效应 对 应 于 其 快 动力 学 特性 。 所 
谓 快 动力 学 是 指 相 对 于 机 器 人 的 整体 动力 学 ， 其 动 
力学 效应 的 特征 时 间 相 对 短 得 多 ， 因 此 可 以 忽略 不 
计 ， 至 少 在 将 这 种 理想 模型 用 于 控制 器 设计 时 "” 
( 见 第 34 38) 。 

本 章 17. 2 节 主 要 介绍 由 纯 滚 动 条 件 所 导致 的 机 
器 人 运动 约束 的 特点 。 文 中 首先 描述 了 在 制造 移动 机 
器 人 时 所 用 到 的 一 些 不 同类 型 的 轮子 ， 并 推导 了 相应 
的 运动 学 约束 。 依 此 我 们 可 以 刻画 各 种 装 有 不 同 数 
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目 、 不 同类 型 轮子 的 机 器 人 的 移动 性 ， 并 说 明 这 些 轮 
式 移动 机 器 人 可 分 为 五 类 ， 对 应 于 两 种 移动 性 指标 。 
17.3 市 介绍 了 四 种 通用 的 状态 空间 模型 及 它们 之 间 
的 联系 ， 利 用 这 些 模型 就 能 够 很 好 地 描述 这 五 类 机 器 
人 的 运动 。 此 外 ,我 们 介绍 了 运动 学 模型 和 动力 学 模 
型 ， 其 中 运动 学 模型 的 输入 是 速度 ， 动 力学 模型 的 输 
入 是 加 速度 (等 效 输 入 也 可 以 是 力 或 力矩 )。 姿 态 空 
间 模 型 对 应 于 机 器 人 运动 的 最 小 描述 ， 而 结构 空间 模 
型 则 是 对 机 器 人 运动 的 完整 描述 ， 包 含 其 内 部 变量 。 
从 控制 器 设计 的 角度 ，17.4 节 中 给 出 了 这 些 模 型 的 
几 种 结构 特性 。 首 先 ， 讨 论 了 与 这 类 机 器 人 相关 的 稳 
定性 、 可 控 性 和 非 完 整 性 。 然 后 ， 又 讨论 了 状态 反馈 
线性 化 的 问题 ， 包 括 静 态 状 态 反 馈 输 入 输出 线性 化 和 
通过 动态 扩展 和 动态 状态 反馈 的 完全 线性 化 。 在 最 后 
一 节 给 出 了 几 种 轮 式 移动 机 器 人 的 实现 。 在 这 些 实现 
中 ， 采 用 了 好 多 种 特殊 的 设计 ， 壁 如 :同步 驱动 、 瑞 
士 轮 、 多 关节 型 机 器 人 。 


17.2 ” 轮 式 机 器 人 的 移动 性 


本 节 描 述 了 多 种 轮子 及 其 在 移动 机 器 人 中 的 应 
用 ,讨论 了 由 使 用 轮子 驱动 所 产生 的 对 机 器 人 移动 
性 的 约束 ， 并 导出 了 一 种 针对 机 器 人 移动 性 的 分 类 
方法 ,无 论 移动 机 器 人 中 所 用 到 轮子 的 类 型 和 数目 ， 
利用 这 种 分 类 方法 都 可 以 完全 地 刻画 机 髓 人 的 移 
动 性 。 


17.2.1 轮子 的 类 型 


为 了 实现 机 器 人 移动 能 力 ， 轮 式 移动 机 器 人 在 
各 种 实际 应 用 中 被 广泛 采用 。 一 般 而 言 ， 轮 式 驱 动 
机 需 人 相对 于 其 他 驱动 结构 (例如 ， 腿 式 机 器 人 和 
履带 式 机 器 人 ) 的 机 器 人 运动 得 更 快 ， 而 消耗 的 能 
量 较 少 。 站 在 控制 的 角度 ， 轮 式 移动 机 器 人 由 于 其 
简单 的 机 械 结构 和 较 好 的 稳定 性 ， 相 对 较为 容易 
控制 。 
尽管 轮 式 机 器 人 在 粗糙 地 形 环境 下 和 不 平整 的 地 
面 应 用 起 来 比较 困难 ， 它 们 却 很 适合 用 在 一 类 实际 应 
用 的 目标 环境 中 。 当 我 们 考虑 一 个 单 轮 驱动 的 移动 机 
器 人 ， 有 两 个 轮子 需要 考虑 : 一 个 标准 轮 ， 也 就 是 我 
们 理解 为 通常 的 轮子 ; 一 个 特殊 轮 ， 这 种 轮子 拥有 辊 
子 和 球 轮 等 独特 的 机 械 结构 。 图 17. 1 是 单 轮 移动 机 
器 人 的 标准 轮 的 一 种 通常 设计 。 

在 设计 标准 轮 时 ， 有 三 种 情况 需要 定义 : 

1) 标准 轮 的 两 个 偏 移 量 d 和 的 选择 。 

2) 标准 轮 的 机 械 设计 是 否 允 许 转 问 运动 (也 就 


Xx 


机 器 人 底盘 


c) 


图 17.1 标准 轮 的 一 般 设计 
a) 侧 视图 b) 主 视图 c) 俯视 图 


是 是 否 固定 轮子 的 方位 ) 。 
3) 标准 论 的 转向 和 驱动 的 选择 (也 就 是 主动 或 
被 动 驱动 的 选择 ) 。 


情况 1 是 单 标准 论 的 运动 学 参数 设计 的 问题 。 参 
Bed (偏心 距 ) 可 以 为 0 或 者 一 个 正常 数 。 侧 向 偏 移 
b 一般 为 0. 在 某 些 特殊 的 设计 中 ， 为 了 保证 轮子 和 
地 面 之 间 为 纯 深 动 运动 ,5b 也 可 能 为 一 个 非 0 值 。 然 
而 ， 这 种 情况 很 少 被 采用 ， 所 以 我 门 主要 考虑 5 为 0 
的 情况 。 

情况 2 是 轮子 方向 能 否 改变 的 设计 问题 。 如 果 轮 
子 的 驱动 轴 是 固定 的 ， 则 该 轮子 在 其 驱动 方向 上 产生 
了 一 个 速度 约束 。 

第 3 种 情况 是 轮子 的 转向 或 滚动 运动 的 驱动 方式 
动 驱动 还 是 被 动 驱动 的 问题 。 

如 果 轮 子 能 够 转向 ， 则 偏心 矩 d 在 运动 学 模型 中 
起 到 很 重要 的 作用 。 对 于 一 个 传统 的 万 向 轮 ( 壁 如 : 


Lu 
um 


E 
AE 
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一 个 偏心 万 向 轮 ) 。 偏 心 矩 4 不 为 0、 图 17. 1 中 的 点 
4 为 机 器 人 底盘 和 轮 组 的 连接 点 。 通 过 偏心 万 向 轮 我 
们 可 以 得 到 两 个 正 交 的 线 速度 ， 从 而 实现 轮子 的 方向 
和 深 动 的 驱动 ， 这 就 意味 着 一 个 被 动 驱动 的 偏心 万 向 
轮 不 会 给 机 器 人 的 驱动 产生 附加 速度 约束 。 如 果 万 向 
轮 的 转向 和 滚动 分 别 装 有 驱动 机 构 ， 通 过 求解 道 向 运 
动 学 问题 ， 点 4 能 够 得 到 任意 速度 ， 因 此 能 够 实现 全 
方位 移动 。 如 果 偶 心 矩 4 为 0， 则 4 点 的 速度 方向 仅 
限制 在 轮子 的 方向 。 在 这 种 情况 下 ， 其 转向 运动 不 能 
再 是 被 动 驱动 的 。 然 而 ， 通 过 驱动 其 他 轮子 ， 我 们 能 
够 被 动 地 知道 其 驱动 速度 。 根 据 非 完整 速度 约束 ， 轮 
子 的 方位 必须 通过 主动 驱动 到 期 望 的 速度 方向 上 。 这 
就 意味 着 这 种 轮子 的 运动 方向 必须 在 运动 的 时 候 实 时 
驱动 得 到 。 

总 结 而 言 ， 常 用 的 标准 轮 有 四 种 类 型 . 第 一 种 是 
方位 固定 的 被 动 驱动 轮 。 第 二 种 是 偏心 矩 为 d 的 被 动 
万 向 轮 。 第 三 种 是 偏心 矩 d 不 为 0， 主 动 驱动 的 万 向 
轮 ， 这 种 轮子 的 转向 和 滚动 均 通 过 执行 融 来 控制 。 第 
四 种 是 偏心 矩 4 为 0 的 主动 驱动 万 向 轮 ， 这 种 轮子 的 
转向 和 滚动 也 是 通过 执行 器 来 驱动 。 图 17. 2 所 示 为 
这 四 种 轮子 的 结构 。17.2.2 节 中 将 详细 说 明 这 些 轮 
子 的 运动 学 和 约束 。 

尽管 标准 轮 由 于 其 简单 的 结构 和 很 好 的 可 靠 性 有 
很 多 的 优势 ,但 是 其 非 完 整 运动 约束 (和 壁 如 ,无 侧 
滑 假 设 ) 限制 了 机 器 人 的 运动 。 男 一 方面 ,为 了 使 
移动 机 器 人 有 全 方位 移动 (全 方位 移动 机 器 人 ) 的 
能 力 ， 也 就 是 保证 机 器 人 在 其 运动 平面 内 有 完整 的 三 
个 自由 度 ， 一 些 特殊 轮 也 常常 被 采用 。 图 17. 3a 所 示 
为 瑞士 轮 。 这 种 轮子 的 外 轮 框 上 套 有 小 的 被 动 自 由 
轮 ， 目 的 在 于 克服 非 完整 运 动 约束 。 被 动 自由 轮 能 够 
绕 其 转动 轴 自 由 转动 ， 从 而 产生 轮子 的 侧 向 运动 。 因 
此 ， 我 们 能 够 控制 其 驱动 速度 ， 其 侧 向 速度 由 该 移动 
机 需 人 上 安装 的 其 他 轮子 的 速度 来 共同 决定 。 图 
17. 3c 所 示 为 球形 轮 。 球 体 的 转动 受 限于 与 其 接触 的 
辊 子 ， 而 辊 子 可 以 分 为 驱动 辊 和 支撑 辊 。 通 过 驱动 驱 
动 辊 ， 就 可 以 达到 驱动 球 轮 的 目的 ， 尽 管 两 者 之 间 的 
滚动 接触 会 带 来 非 完整 约束 ， 球 轮 的 整体 运动 是 完整 
的 。 这 就 意味 着 机 器 人 在 任何 时 刻 可 以 以 任何 期 望 的 
线 速度 /角速度 运动 。 通 过 使 用 球 轮 ， 就 可 以 开发 出 
一 个 完整 的 全 方位 移动 机 器 人 ， 这 种 移动 机 融 人 的 球 
形 轮 和 地 面 之 间 的 接触 是 连续 光滑 的 。 然 而 ， 支 持 球 
形 轮 的 机 械 设计 是 比较 困难 的 ， 并 且 这 种 类 型 的 轮子 
由 于 接触 点 的 缘故 ， 负 载 能 力 较 小 。 另 外 一 个 缺陷 就 
是 球 轮 在 脏 地 面 上 运行 的 时 候 ， 其 外 表面 很 容易 弄 
脏 ， 因 此 它 很 难 在 复杂 地 面条 件 下 应 用 。 这 种 缺陷 限 


图 17.2 标准 轮 结构 
a) 固定 轮 b) 主动 式 或 被 动 式 偏心 万 向 轮 


c) 无 偏心 主动 万 向 轮 


制 了 球形 轮 的 实际 应 用 。 参 考 文献 [17.2] 和 
[17.3] 是 球形 轮 的 应 用 实例 ， 球 形 轮 亦 可 用 在 特殊 
机 器 人 的 传送 中 ， 璧 如 参考 文献 [17.4] 中 所 包含 
的 非 完 整 机 械 臂 以 及 参考 文献 [17.5] 中 的 被 动 触 


WRAP 


17.2.2 ”运动 学 约束 


第 一 步 ， 假 设 我 们 所 研究 的 移动 机 器 人 的 车 体 是 
刚性 的 ， 车 轮 形变 可 以 忽略 不 计 ， 且 在 水 平面 上 运 
行 。 机 器 人 的 位 置 可 通过 其 位 姿 向 量 (x y 6) 在 
惯性 系 下 描述 ， 其 中 x 和 y 表示 机 器 人 车 体 上 参考 点 
在 选 定 惯性 系 下 的 坐标 ,9 表示 机 器 人 联 体 坐 标 系 相 
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图 17.3 球形 轮 的 应 用 ( 见 参 考 文献 [17.2] ) 


a) 瑞士 轮 b) 瑞士 轮 的 连接 c) 球形 轮 


对 于 选 定 惯性 系 的 方位 。 移 动机 器 人 在 平面 内 的 位 姿 
定义 如 图 17.4 所 示 。 

此 外 ， 我 们 假设 每 个 轮子 的 轮 面 在 运行 过 程 中 均 
与 地 面 垂直 ， 且 沿 其 水 平 轴 旋 转 ， 这 些 轮 的 方向 相对 
于 车 体 而 言 ， 有 可 能 是 固定 的 也 有 可 能 是 变化 的 。 对 


h 


机 器 人 底盘 


图 17.4 移动 机 器 人 在 平面 内 的 位 姿 定义 


于 理想 轮 ， 我们 以 所 谓 的 常规 轮 和 瑞士 轮 予 以 分 类 。 
在 每 种 情况 下 ， 我 们 假设 轮子 与 地 面 的 接触 为 一 个 
点 ， 因 此 ， 轮 子 与 地 面 之 间 的 接触 点 为 相对 不 动 点 ， 
并 由 此 产生 运动 学 约束 。 对 于 传统 轮 而 言 ， 运 动 学 约 
束 意味 着 轮子 中 心 的 运动 速度 轮 面 平行 ( 非 滑动 条 
件 ) ， 且 正比 于 轮子 的 转动 速度 ( 纯 滚 动 条 件 ) X 
于 每 一 个 轮子 而 言 运动 学 约束 导致 连 个 独立 的 条 件 。 
对 于 瑞士 轮 而 言 ， 由 于 驱动 辊 与 轮子 之 间 的 相对 转动 
的 缘故 ， 接 触 点 仅 有 一 个 速度 分 量 为 0.0 速度 分 量 的 
方向 相对 与 轮 面 固定 且 依 赖 于 轮子 的 结构 。 对 于 这 种 
轮子 ， 仅 在 一 种 条 件 下 产生 运动 学 约束 。 

1. 传统 轮 

我 们 现在 推导 传统 轮 运 动 学 约束 的 通 式 。 

如 图 17. 2 所 示 ， 传 统 轮 的 设计 有 很 多 变化 的 形 
式 。 首 先 ， 我 们 集中 精力 研究 图 17. 2b 中 所 示 的 偏心 
万 向 轮 。 轮 子 的 中 心 B 点 通过 一 根 夹 持 在 轮 面 上 ， 
并 通过 连接 4 点 (小 车 上 的 某 固定 点 ) 到 8B 点 的 刚 
性 连 杆 连接 到 小 车 上 。 长 度 为 d 的 连 杆 能 够 绕 过 4 点 
并 垂直 于 小 车 底面 的 轴 转 动 。4 点 的 位 置 可 以 通过 极 
坐标 系 下 的 相对 于 原点 P 的 两 个 常数 给 定 ， 也 就 是 1 
和 a。 连 杆 相 对 于 小 车 的 转动 量 可 用 角 B 来 表示 ， 轮 
子 的 半径 为 -， 其 相对 于 其 水 平 轴 的 转动 量 为 op。 因 
此 ， 与 约束 相关 的 量 有 四 个 常数 : w、!、r、d， 两 个 
变数 : p(t) AB(t) 

利用 这 些 符号 ， 运 动 学 约束 可 以 推导 如 下 。 

在 这 里 ， 我 们 仅 对 通用 情形 下 的 偏心 轮 ( 见 图 
17.2b) 进行 推导 。 对 于 固定 轮 或 方向 轮 ， 可 以 看 做 
是 d=0, B 为 常数 , 或 d=0, B 为 变数 (方向 轮 ) 。 

首先 ， 我们 计算 一 下 轮子 中 点 的 速度 ， 该 速度 由 
以 下 向 量 表达 式 : 
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d d d d 
dp 0B o a OP t PA t GAB 


在 机 器 人 坐标 系 中 ， 速 度 向 量 沿 X 轴 和 YY 轴 两 个 分 
量 可 以 表示 成 : 


x cosÓ + ysing 16 sina 4 (6 | B)dcos(a +B) 和 


— x sin + yeosg -10 cosa + (0 + B)dsin(a +B) 
该 速度 向 量 投 影 到 轮 面 方向 上 ， 也 就 是 在 向 量 (cos 
(a+B-7/2), sn(a*-B-m/2)) 和 轮轴 向 量 (cos 
(a+B) ，sin(a+B))， 可 表示 为 rp 和 0， 对 应 于 纯 


滚动 和 无 打滑 情况 下 ， 经 过 相关 处 理 ， 这 些 约 束 条 件 

可 写作 以 下 紧凑 形式 : 

纯 滚 动 条 件 : 

( -sin(a * B) cos(a * 8) lcosB) - R(0) > Etro =0 
(17.1) 

无 打滑 条 件 : 

( -cos(a+B)sin(a+B)d+lsinB) - R(0) - € «df =0 
(17.2) 


在 以 上 表达 式 中 , RCO) 表示 正 交 旋 转 和 矩阵 ， 其 含义 
为 机 器 人 相对 于 惯性 系 的 方向 ， 亦 即 . 
cosO sing 0 
—sinÜ cosü 0 
0 0 1 
正如 上 文 所 述 ， 这 些 通用 表达 式 对 于 不 同类 型 的 传统 
轮 可 以 再 做 简化 。 

对 于 固定 轮 ， 轮 中 心 相 对 于 小 车 固定 且 轮 的 方向 
为 常数 。 相 应 的 d=0, BARB (MA 17.2a)。 无 
滑动 方程 (17. 2) 可 以 简化 为 : 

(cos(a * B)sin(a +B) lsinB) - R(0) - £s 

(17.4) 

对 于 方向 轮 轮 中 心 相 对 于 小 车 亦 固 定 
(d=0), 而 B 是 随时 间 变 化 的 ， 因此， 无 滑动 方程 
亦 为 式 (17.2) 的 形式 。 这 种 轮子 的 结构 在 图 17. 2c 
中 已 经 作 过 介绍 。 

而 对 于 连 杆 AB 距离 不 为 0 H B 是 随时 间 变 化 的 
遍 心 万 向 轮 ， 则 可 用 式 (17.1) MA (17.2) 表示 
其 约束 条 件 。 

2. 瑞士 轮 

对 于 瑞士 轮 的 固定 轮 ， 其 相对 于 小 车 的 位 置 取决 
于 三 个 常数 : a, BFL, 另外 还 需要 一 个 附加 参数 来 
描述 该 轮 相 对 于 轮 面 的 接触 点 的 零 速 度 分 量 方向 。 这 
个 参数 为 yx， 也 就 是 驱动 辊 相对 于 轮 面 的 方向 ( 见 图 
17.3b) 。 其 运动 约束 仅 在 一 种 情况 下 产生 影响 : 

( -sin(a +B * y)cos(a * B * y)lcos(B * y) ) 


R(0) = (17.3) 


xR(0)£ +reos yp =0 
17.2.3 机 器 人 的 结构 变量 


我 们 现在 考虑 轮 式 机 器 人 ， 这 些 机 器 人 可 能 装配 
有 上 文 所 述 类 型 轮子 的 一 种 或 几 种 。 我 们 用 以 下 下 标 
来 确定 四 种 类 型 轮子 的 数量 : f 表示 固定 轮 ，s 表示 
方向 轮 ，e 表示 偏心 万 向 轮 ， 而 sw 表示 瑞士 轮 。 每 
种 类 型 的 轮子 表示 为 WN、N、N. 和 N.， 总 轮 数 表 示 
AAN=N,+N,+N,+N,,0 

机 器 人 的 配置 可 以 通过 以 下 配置 空间 向 量 来 完全 
描述 。 

1) 位 姿 坐 标 系 : 位 姿 向 量 &(1) = (x(t) y) 
O) ) "o 

2) 方位 坐标 系 : 方向 轮 和 偏心 万 向 轮 的 N+ N。 
MIAA, BREBU) =U) BO). 

3) 旋转 坐标 系 : NN 个 轮子 的 个 旋转 角 ， 亦 即 
pt) =P) PA) p(t) e,Q0)'. 

所 有 坐标 系 的 集合 构成 了 配置 空间 坐标 系 。 配 置 
空间 的 维 数 为 W +2N. -2N, +N 3. 


17.2.4 机 器 人 移动 性 的 约束 


回 定 轮 、 方 向 轮 以 及 偏心 万 向 轮 的 纯 滚动 条 件 ， 
以 及 与 瑞士 轮 相关 的 约束 条 件 可 以 表示 成 以 下 紧凑 
形式 : 


(17.5) 


J(B,.8.) R0) .E+ 万 .9 =0 (17.6) 
Ju 
JBA 
PAG, B=) 7 ve 
te 


在 以 上 表达 式 中 ,， Ju. JCB). Si (Be) 和 J 分 别 
表示 (N,x3), (N, x3), (N, x3) fl CN, x3) 的 
ABE, CHES UE EC BEA s al A6 23 d rp ESSE folk, Tf 
J,J&—^r N x N 维 的 常 对 角 阵 ， 该 对 角 阵 上 的 元 素 为 
各 个 轮子 的 半径 ， 值 得 注意 的 是 ， 瑞 士 轮 还 需要 乘 一 
个 COSYo 

当 y= 卫 时， 意味 着 速度 的 零 分 量 方向 正 交 与 瑞 
士 轮 的 轮 面 方向 。 这 样 的 一 个 轮子 将 受到 一 个 与 传统 
轮 无 滑动 约束 等 价 的 一 个 约束 ， 因 此 ， 就 无 法 发 挥 瑞 
士 轮 的 优点 。 这 就 意味 着 y = HIN, JL ARE RHET 
异 的 。 


偏心 万 向 轮 的 无 滑动 条 件 可 总 结 ; 


Ci.(B.) - R() -£«C,, + B, =0 


(17.7) 
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RP, Ch (B) AN, x3 和 矩阵， 它 的 元 素 直接 从 式 
(17.2) 所 示 的 无 滑动 条 件 推导 得 来 ，C;. 为 非 奇 异常 
数 对 角 阵 ， 其 元 素 为 do 

固定 轮 和 方向 轮 与 无 滑动 条 件 相 关 的 最 后 一 个 约 
BRAT UL 


C; (B.) + R(@) + £ -0 
C, 
ster (8) = [C0 )) iei qo SH 


N, x3 AIN, x 3 的 矩阵 。 
值得 指出 的 是 由 固定 轮 和 方向 轮 相关 的 条 件 
( 式 (17.8)) 所 导致 的 机 器 人 的 移动 性 约束 。 这 些 


条 件 意味 着 向 量 R(b) - & 属于 N [Cr (8.) ], ui 
C; (B.) 的 零 空间 。 对 于 任意 满足 条 件 的 R(9) - £, 


总 存在 一 个 向 量 @ 和 一 个 向 量 B, 满 足 式 (17.6) 和 
式 (17.7) BA, AA JM C 是 非 奇 异 的 矩阵 。 
显然 有 rank[ Cr (8.)] 入 3。 因为 如 果 rank[ Cr 


(B.)] =3 E.RCO) - £ =0， 则 意味 着 在 平面 内 任何 
运动 都 不 可 能 产生 。 更 一 般 地 说 ， 与 矩阵 CY (B) 
的 秩 相 关 的 机 器 人 移动 性 约束 ， 将 在 下 文 详细 说 明 。 

值得 注意 的 是 ， 条 件 (17.8) 有 直接 的 几何 含 
义 ， 在 每 一 个 瞬间 ， 机 器 人 的 运动 可 以 被 看 做 是 相对 
于 瞬时 旋转 中 心 (ICR) 的 一 个 瞬时 旋转 ， 而 这 个 瞬 
时 旋转 中 心 相 对 于 小 车 是 时 变 的 。 在 任意 时 刻 ， 小 车 
上 的 任意 点 的 速度 正 交 与 连接 该 点 与 ICR 点 的 直线 。 
特别 是 对 于 固定 轮 和 方向 轮 的 中 点 (相对 于 小 车 的 不 
动 点 ) ， 更 是 如 此 。 另 外 一 方面 ， 无 滑动 条 件 意味 着 
轮子 中 点 的 速度 与 轮 面 是 一 致 的 。 这 两 个 事实 说 明 固 
定 轮 和 方向 轮 的 水 平 旋转 轴 相 交 于 瞬时 转动 点 ICR 
(如 图 17. 5 所 示 )。 这 和 rank[ CY (8,) ] «3 是 一 致 的 。 


(17.8) 


图 17.5 转动 的 瞬时 中 心 
a) 车 式 机 器 人 b) 3 方向 轮 驱 动 的 机 器 人 


17.2.5 机 器 人 移动 性 的 描述 
如 上 文 所 述 ， 机 器 人 的 移动 性 直接 与 矩阵 C] 


(B.) 的 秩 相 关 ， 而 C; (B.) 的 秩 则 只 与 其 设计 相 
关 。 我 们 定义 移动 性 的 度 为 5,， 且 有 
6, =3 - rank(C, (B.) ) (17.9) 

首先 考虑 一 下 rank( Ci) =2 的 情况 ， 这 种 情况 意味 着 
机 器 人 至 少 有 两 个 固定 轮 ， 如 果 多 于 两 个 ， 它 们 的 水 
平 转动 轴线 相交 于 ICR。 显 然 ， 从 用 户 的 角度 ， 这 种 
设计 是 难以 接受 的 ， 因 此 ， 我 们 假设 rank( C,,) <1, 

更 进一步 ,我 们 假设 rank[ Cj (B,) ] = rank(C,,) + 
rank[ C,,(B,) ] 大 2， 这 两 个 假设 和 以 下 的 几 个 条 件 是 
等 价 的 : 

1) 如 果 机 器 人 有 多 于 一 个 固定 轮 ， 则 它们 转动 
轴 为 同一 个 轴 。 

2) 方向 轮 的 中 点 不 在 固定 轮 的 转动 轴 上 。 

3) rank [Cr (8.) ] 等 于 方向 轮 的 个 数 ， 这 些 方 
向 轮 能 够 独立 地 转动 方向 以 控制 机 器 人 的 运动 方向 。 
称 该 数 为 可 控制 度 

6.=rank [C,, (B,) ] (17. 10) 

如 果 机 器 人 装配 有 多 于 5. 个 方向 轮 ， 则 这 个 附加 
的 轮子 的 运动 必须 和 其 他 轮子 协调 以 保证 每 个 瞬间 都 
存在 ICR。 对 于 针对 于 应 用 的 轮 式 驱动 的 移动 机 器 
人 ， 我 们 可 以 下 结论 : 5. 和 6 ,满足 以 下 条 件 : 

1) 移动 度 满 足 : 1<6, 二 3 。 上 界 的 含义 是 明 
显 的 ， 而 下 界 则 意味 着 我 们 仅 考 虑 运动 时 可 行 的 
情况 。 

2) 方向 度 满 足 : 0<6. <2。 上 界 仅 在 机 器 人 没 
有 安装 固定 轮 的 情况 下 得 到 ， 而 下 界 对 应 于 机 器 人 没 
有 安装 方向 轮 的 情况 。 

3) 以 下 式 子 满足 : 2x6, +8, <3, ô, +6, =1 是 
不 可 行 的 ， 因 为 其 对 应 于 机 器 人 绕 固定 ICR 转动 的 
情况 下 。 根 据 上 文 的 假设 就 ，5, 三 2 和 6, 22 被 排 
除 。 AO, =2 则 意味 着 5 = 1， 对 于 实际 应 用 而 言 ， 
这 种 条 件 意味 着 仅 有 五 种 结构 ， 对 应 于 (6,， 09.) Wü 
足以 上 不 等 式 的 五 种 情况 ， 这 五 种 情况 可 依照 以 下 
数列 : 


& 32211 
5 00112 
在 下 文中 ,每 种 结构 类 型 的 机 器 人 将 通过 形 如 
(n, 6,) 的 机 器 人 来 说 明 。 


17.2.6 轮 式 移 动机 器 人 的 五 种 类 型 


我 们 现在 简单 地 描述 以 下 五 种 类 型 的 轮 式 移动 机 
器 人 ， 并 指出 与 每 种 类 型 相关 的 移动 约束 。 具 体 细 节 
和 范例 可 在 17. 5 节 和 参考 文献 【17. 6] 中 找到 。 

1. (3, 0) 类 机 器 人 

此 种 类 型 的 机 器 人 没有 固定 轮 和 方向 轮 ， 仅 仅 
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装 有 瑞士 轮 或 偏心 万 向 轮 ， 被 称 为 全 方位 移动 机 器 
人 。 因 为 它们 有 平面 内 运动 所 需 的 全 部 自由 度 ， 这 
就 意味 着 它们 能 够 沿 任意 方向 运动 而 不 需要 重新 
转向 。 

2. (2, 0) 类 机 器 人 

这 类 机 器 人 没有 转向 轮 ， 但 是 都 有 一 个 或 者 几 个 
同 轴 的 固定 轮 。 移 动 性 约束 可 描述 为 ， 对 于 给 定 的 位 


WEU), IUE EU) 被 约束 在 由 两 个 向 量 场 R'(0) 
si 和 R"'(9)s, 张 成 的 二 维 分 布 上 ， 其 中 s M s HAA 
常 向 量 。 这 类 机 器 人 的 典型 例子 是 轮椅 。 

3. (2, 1) 类 机 器 人 

这 类 机 器 人 没有 固定 轮 ， 但 至 少 有 一 个 方向 轮 。 
若 有 多 于 一 个 方向 轮 ， 它 们 的 方向 必须 以 如 下 方式 协 


调 rank[C,,(8,) ] =ô, =1. 其 速度 £ (0). 被 约束 在 由 
两 个 向 量 场 R'(0)s,(B.) 和 R'(09)s,(B.) 张 成 的 二 
维 分 布 上 ， 其 中 s (B) Fils, (B) 是 张 成 N(C. 
(B.)) 的 两 个 向 量 。 

4. (1, 1) 类 机 器 人 

这 类 机 器 人 有 一 个 或 几 个 同 轴 的 固定 轮 ， 并 装 有 
一 个 或 几 个 方向 轮 。 在 这 几 个 方向 轮 的 中 点 不 在 同一 
直线 上 的 情况 下 ， 它 们 的 方位 必须 协调 。 其 速度 


& (1 被 约束 在 一 个 一 维 分 布 上 ， 该 分 布 由 任意 选 定 
的 主动 方向 轮 的 方位 角 参 数 化 。 基 于 传统 小 轿车 模型 
建立 的 机 器 人 属于 这 种 类 型 。 

5. (1, 2) 类 机 器 人 

这 类 机 器 人 没有 固定 轮 ， 但 至 少 有 两 个 方向 轮 。 
如 果 装 的 方向 轮 多 于 两 个 ， 则 它们 的 运动 方向 必须 协 
调 ， 并 满足 rank [C.(B.)] =6, =2。 其 速度 £ (2) 
被 约束 在 一 个 一 维 分 布 上 ， 该 分 布 由 任意 选 定 的 主动 
方向 轮 的 方位 角 参 数 化 。 


轮 式 移动 机 器 人 的 状态 空间 
模型 


kami 


17.3 


在 这 一 他 中 ， 前 文 所 讨论 的 移动 性 分 析 用 状态 空 
间 的 形式 重新 描述 ， 这 将 有 益 于 随后 的 开发 。 我 们 介 
绍 了 四 种 类 型 的 状态 空间 描述 ， 其 目的 在 于 理解 轮 式 
机 器 人 的 行为 ， 并 为 控制 器 的 设计 黄 定 基础 。 

1) 姿态 空间 运动 学 模型 。 从 使 用 者 的 角度 ， 这 
种 模型 是 一 种 能 够 对 机 器 人 进行 全 面 描述 的 最 简单 的 
状态 空间 模型 。 

2) 结构 空间 运动 学 模型 。 这 种 模型 能 够 描述 整 
个 机 器 人 的 运动 行为 ， 包 括 所 有 的 结构 变量 。 


3) 结构 空间 动力 学 模型 。 这 种 模型 是 最 通用 的 
状态 空间 模型 。 它 给 出 了 各 个 动态 的 全 面 描 述 ， 包 括 
由 执行 器 产生 的 各 个 力 。 尤 为 特别 的 是 ， 它 容许 我 们 
提出 执行 结构 的 问题 ， 并 定义 一 个 标准 去 检查 执行 器 
的 动力 是 否 足 够 去 发 挥 运动 学 的 移动 性 。 

4) 姿态 空间 动力 学 模型 。 该 模型 反 向 等 价 于 结 
构 空间 模型 ， 构 成 了 相对 于 姿态 空间 运动 学 模型 的 动 
力学 描述 。 


17.3.1 姿态 空间 运动 学 模型 
我 们 已 经 表明 ， 无 论 机 器 人 是 什么 类 型 ， 它 的 速 
ERE EU) 都 被 约 东 在 一 个 分 布 4 上 ，A 定义 为 


eA, «span. {col [R" (6) X (B,)]| 
RP, EEE) MAST NCC (OO) 的 


基 ， 这 等 价 于 以 下 描述 : 对 于 所 有 的 1， 总 存在 一 个 
矢量 ,使 得 下 式 成 立 
& =R'(0)5(B.) ^m (17.11) 


AF y(t) 的 维 数 等 于 机 器 人 的 移动 度 56,。 显 然 ， 在 
机 器 人 未 装 方向 轮 的 情况 下 ， 和 矩阵 瑟 是 常 矩 阵 ， 则 
式 (17.11) 可 简化 为 


E -R'(0X -n (17. 12) 

在 相对 的 另 一 种 情形 (8,21), EES HA RR 
方位 角 B., Wet (17.11) 可 写成 如 下 形式 

E -R'(0)X(B.) ^ m (17.13) 

Bos (17.14) 


式 (17.12) (或 式 (17.13) 和 式 (17.14)) 可 以 看 
做 是 模型 的 状态 空间 表示 ， 反 映 了 由 约束 引起 的 机 动 
约束 ， 它 被 表述 成 姿态 空间 运动 学 模型 。 

状态 变量 由 三 维 位 姿 矢 量 专 (1) ,或 6. 维 方位 向 
量 B. 组 成 。5,, 维 矢量 7 和 6. 维 矢量 专 与 速度 是 同一 
的 ， 并 能 够 被 认为 是 模型 的 控制 输入 。 然 而 ， 这 种 看 


法 应 该 小 心 对 待 ， 因 为 系统 的 真正 物理 输入 是 由 执行 
器 提供 的 。 姿态 空间 运动 学 模型 实际 上 仅仅 是 


17. 3. 3 中 所 述 模型 的 一 个 子 系统 。 

姿态 空间 运动 学 模型 是 我 们 能 进一步 讨论 轮 式 机 
器 人 的 机 动 性 。 移 动 度 6, SEPARA na) 中 能 够 
直接 操纵 的 量 的 自由 度数 ， 而 不 需要 将 方向 轮 重 定 
向 。 直 观 上 ， 它 对 应 于 机 器 人 在 当前 位 置 无 需 转动 任 
可 轮子 就 拥有 的 自由 度数 。5, 不 等 于 机 器 人 能 够 操纵 
的 输入 量 w(t) 和 Z(t) 的 自由 度数 的 总 和 ， 也 就 是 
8, =6, +6,，6u 被 称 之 为 机 动 度 。 它 包含 由 输入 6(1) 
得 到 的 8. 维 自由 度 。 


=> 
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然而 ,由 Z(t) 所 产生 的 对 &(1) 的 作用 是 间接 ， 
因为 它 必 须 通 过 BB, 起 作用 ,而 B. 与 E(t) 是 积分 相关 
的 ， 这 就 导致 方向 轮 的 方位 改变 不 能 在 瞬时 达到 。 轮 
式 移 动机 器 人 的 机 动 性 不 仅仅 依靠 6, ， 也 和 Sy P ÉS 

5. 中 组 合 形式 有 关 。 因 此 ， 机 器 人 的 机 动 性 需 
要 两 个 指标 来 表征 。 显 然 理想 条 件 是 全 方位 移动 机 
器 人 ， 也 就 是 sw =5, =3。 为 了 避免 毫 无 用 处 的 符 
号 复杂 化 ,我们 假设 方向 度 等 于 方向 轮 的 个 数 ， 也 
就 是 N. =6.。 从 机 器 人 设计 的 角度 ， 这 是 一 个 限制 
条 件 。 然 而 ， 对 于 移动 机 器 人 运动 行为 的 数学 分 析 
的 角度 而 言 ， 这 种 假设 并 未 丧失 一 般 性 ， 可 以 认为 
简化 了 技术 推导 过 程 。 诚 然 ， 对 于 拥有 宛 余 方 向 轮 
的 机 器 人 ， 总 是 有 可 能 弱化 条 件 (17.8) ， 也 就 是 
能 从 6. 个 方向 轮 中 选 出 一 个 独立 最 小 集合 来 控制 机 
器 人 ， 只 要 选 定 了 主动 轮 后 ， 在 分 析 中 就 可 以 忽略 
其 他 从 动 轮 。 


17. 3.2 


结构 空间 运动 学 模型 


为 了 讨论 移动 性 约束 ， 我 们 已 经 考虑 了 含 运动 学 
约束 条 件 的 一 个 子 集 ， 也 就 是 所 谓 的 方向 轮 和 固定 轮 


无 滑动 条 件 。 我 们 现在 利用 其 他 余下 的 约束 来 推导 e 


和 偏心 万 向 轮 的 速度 B.。 从 式 (17.6) 和 式 
(17.7) 即 可 以 得 到 如 下 结论 

B.- -CiC,R(OE (17.15) 

-J; 4(B,.B.)R()£ — (17.16) 


Boxes i i eer p. f 
9 的 状态 模型 变 为 


B.- -D(B)X(B.n (17.17) 
e--E(B.B.)X(B)m (17.18) 
式 中 
D(B.)--Cj C.(B), H E(B., B.) = 
-J;' -Ji (Ba, B). 
定义 结构 空间 变量 g， 也 就 是 
é 
B. 
7B. 
e 


Ht q 进一步 变形 ， 可 用 以 下 形式 来 描 
Xo oa Uri Re. 


q=S(q) >u (17.19) 


R'(02(B.) 0 
0 I 
D(B.)X(B.) 0 
X(B.B.) 0 


S(q) = (17. 20) 


n 
a= [7] 
g 是 一 个 能 够 完整 描述 机 器 人 的 姿态 和 机 器 人 的 各 个 
轮子 运动 状态 的 广义 坐标 矢量 。 
约束 (17.6), (17.7) 及 式 (17.8) 可 以 总 结 
为 以 下 统一 形式 : 
J(q)q =0 (17.21) 
IP, J(q) 为 雅 可 比 矩 阵 : 
J(B,.B.)R(0) 0 0 J, 


J(q) =| C (B.R) 0 C, 0 
C/(B)R(0 0 0 0 
(17.22) 
S(q) 和 矩阵 和 J(4) 矩阵 满足 下 式 
S(q)J(q) =0 (17. 23) 
17.3.3 结构 空间 动力 学 模型 


我 们 现在 来 推导 结构 空间 动力 学 模型 。 从 机 械 的 
角度 来 看 ， 这 种 模型 建立 了 系统 的 完整 描述 ， 使 得 我 
们 建立 了 执行 器 的 控制 输出 和 广义 坐标 矢量 q 之 间 的 
联系 。 这 种 模型 通过 拉 格 朗 日 法 得 到 。 

我 们 假设 安装 在 机 器 人 上 的 执行 机 构 不 仅 能 够 驱 
动 方向 轮 和 偏心 万 向 轮 的 转向 ， 也 能 够 驱动 其 他 轮子 
的 转向 。 由 执行 器 所 产生 的 力矩 中 ze 表示 轮子 的 滚动 
力矩 ,+ 表示 偏心 万 向 轮 的 转动 力矩 , 志 表 示 方 向 轮 
的 转动 力矩 。 

利用 拉 格 朗 日 法 ， 我 们 能 够 得 到 以 下 方程 


d im (Z) -r+ (17.24) 
d 


dt \ a oq 
在 此 方程 中 
1) T(q, q) 表示 机 器 人 的 动能 ， 形 成 二 项 式 
形式 为 T(g,，9) = 二 47M(B.)4， 其 中 M(B.) 为 
正定 对 称 和 矩阵 。 


0 
2) THI RH, t=] PI. 
M 
3) J'(q)A 由 运动 学 约束 所 产生 的 广义 力 向 量 。 
A 为 与 约束 相关 的 拉 格 朗 日 乘 子 。 
根据 以 上 有 关 动 能 的 表述 , 式 (17.19) 可 重 
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写成 (通过 静态 光滑 时 不 变 状态 反馈 ) 于 以 下 系统 。 


M(B.) 4 +f(q,g) =T+J'(q)A (17.25) 
(具体 见 2.3 节 中 有 关 刚 体系 统 动力 学 的 说 明 ) 。 
st (17.25) 左 乘 $S(g)， 利用 式 (17.23 ) ， 则 可 以 
肖 除 拉 格 朗 日 算 子 。 更 进一步 ， 利 用 式 (17.19). 按 
照 以 下 方式 又 可 以 消除 9 Mq 


[S"(q)M(B,)S(q) ]u +[S"(q)M(B,)S(q)ut 


ay 


S"(q)f(q.8(q)u)]=S"(q)T (17.26) 
或 者 写 得 更 紧凑 点 
H(q)u+F(q,u) -S'(q) T (17.27) 


此 方程 和 式 (17.19) 所 示 的 结构 空间 运动 学 模 
型 方程 构成 了 机 器 人 的 结构 空间 动力 学 模型 。 

在 通 式 (17.27) 中 , + 代表 所 有 人 能够 使 得 轮子 
转动 和 滚动 的 力矩 。 然 而 在 实际 中 ， 仅 有 有 限 数目 的 
执行 器 能 够 应 用 ， 这 就 意味 着 该 变量 中 有 很 多 元 素 为 
0。 我 们 现在 的 目的 在 于 充分 利用 执行 器 的 机 构 特 点 
来 充分 实现 姿态 空间 运动 学 模型 中 所 预期 的 的 机 
动 性 。 

首先 ， 所 有 的 方向 轮 都 必须 至 少 有 一 个 驱动 器 
来 控制 其 方位 ， 否 则 这 些 轮子 只 能 当 固 定 轮 来 用 。 
更 进一步 而 言 ， 为 了 保证 整个 机 器 人 的 移动 性 ， 必 
须 装 配 有 Na CN, SEn) 个 附加 的 执行 器 来 实现 某 些 
轮子 的 转动 或 某 些 偏心 万 向 轮 的 转动 。 由 宛 余 执行 
器 所 产生 的 力矩 向 量 可 用 Tw 来 表示 ， 并 且 我 们 能 


写 出 
Te 
(g =P t (17.28) 
AP, 了 为 一 个 (CN, +N) XN) 的 初等 阵 来 选择 
TE Tm PERAI TI ep. 中 的 元 素 ， 这 些 元 素 将 被 
用 作 控 制 输入 。 基 于 这 些 符 号 ,动力 学 方程 
(17.27) 能 够 重 写成 
了 0 T. 
Hai Fa) =| m 


-r(8..8) (7 ) 


(17. 29) 
式 中 , B(B.,B.) -X (B.) (D' (B.E (B.,B.)) o 
必须 指出 的 是 当 给 定 己 〈 等 价 于 执行 器 的 实现 ) ， 
H B(B,, B.) PXIT PUB] (B, B.) LR, WAE 
指定 变量 w 的 具体 形式 。 我 们 假设 最 终 这 种 条 件 能 够 
满足 ， 因 此 ， 这 就 保证 了 机 融 人 充分 利用 其 潜在 机 
动 性 。 


17. 3.4 


姿态 空间 动力 学 模型 
基于 上 文 假设 ,配置 空间 动力 学 模型 反馈 等 效 


q =S(q)u (17. 30) 

u =v (17.31) 

式 中 , v ER 8。+ 8. 个 辅助 独立 控制 输入 的 一 个 
集合 。 

状态 反馈 给 定 如 下 
(5 )er' (BBA LH(g) -F(q,u)] 

(17.32) 

RP, P'368 THERE ( 见 6.6 PAXE 
控制) 。 


从 操作 的 角度 ,我们 强调 一 个 更 进一步 的 简 
化 令 人 很 感 兴趣 。 在 有 关 轨 迹 规 划 和 反馈 控制 设 
计 中 上 下 文中 ， 显 然 用 户 最 关心 的 是 通过 控制 系 
统 输入 来 控制 机 器 人 的 位 姿 〈 也 就 是 所 谓 的 位 置 
RE E(t) )。 这 就 意味 着 我 们 能 有 意 避 开 矢量 B. 
和 的 影响 ， 并 集中 我 们 的 注意 力 在 以 下 的 姿态 
空间 动力 学 模型 ; 


z -B(z)u (17.33) 
u =v (17.34) 
式 中 
(£6 zi |[R(0)2(B.) 0 
z- a u= C KI B(z) -[ i a 


第 一 个 式 子 就 是 式 (17.12) 所 示 的 姿态 空间 运动 学 
模型 。 两 者 的 差别 在 于 输入 变量 式 (17.34) 中 出 现 
了 积分 项 ， 因 此 变量 w 是 状态 矢量 的 一 部 分 。 这 就 导 
致 动力 学 模型 中 出 现 了 于 一 个 序 项 。 姿 态 空间 状态 学 
模型 完整 地 描述 了 位 置 矢 量 才 (上 ) 和 控制 输入 v 之 间 
的 系统 动态 。 虽 然 B .和 4 没有 体现 出 来 ,但 要 注意 
到 它们 隐藏 在 反馈 中 ( 式 (17.32) ) 。 


17.3.5 多 关节 型 机 器 人 


迄今 为 止 ， 我 们 仅仅 考虑 了 简单 的 移动 机 器 人 ， 
也 就 是 仅 由 小 车 组 成 的 机 避 人 。 在 这 一 节 中 ， 我 们 将 
MATT RAI AOL AP, RP La AEE 
由 一 个 主 车 和 几 个 拖车 组 成 。 典 型 的 例子 就 是 著名 的 
带 拖车 的 货车 系统 。 
每 个 拖车 可 装 有 第 17. 2. 2 节 中 的 所 述 类 型 的 轮 
子 ， 驱 动 的 或 者 不 驱动 的 。 相 关 结 构 的 可 能 类 型 的 数 
目 几 乎 是 无 限 的 。 这 就 是 我 们 为 什么 把 有 关 分 析 集 中 
在 仅 装 有 固定 轮 的 被 动 拖 车 上 的 原因 〈 拖 车 上 无 驱 
Syd). 

在 我 们 的 考虑 中 ， 主 车 的 结构 有 可 能 包括 上 文 所 
述 的 5 种 中 的 任何 一 种 。 第 一 个 拖车 连接 在 主 车 上 ， 
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也 就 是 拖车 上 的 一 个 点 和 主 车 上 的 一 个 点 连接 在 一 
起 。 拖 车 相对 于 主 车 的 的 位 置 可 以 用 9 来 表示 。 拖 
车 由 一 个 或 多 个 固定 轮 组 成 。 若 有 多 个 轮子 ， 则 它们 
有 相同 的 几何 轴 。 对 于 一 串 由 N, 个 拖车 组 成 的 系统 ， 
第 二 个 拖车 连接 在 第 一 个 拖车 上 ， 第 二 个 拖车 的 位 置 
为 96,， 并 以 此 类 推 。 

扩展 后 的 系统 的 位 姿 矢 量 扩展 成 为 一 个 3 + Ni, 的 
广义 位 姿 和 撩 量 : 


p| É J 共和 为 主 车 的 位 次 拓 量 ， 而 0 为 


B.-c (17.40) 
HERE J” MI S" Wi DA ORA 
J’ (B,,0,0, ,gwv)S (B,,0,0, ,gw ) =0 
(17.41) 
X (07.37) 给 出 了 每 个 拖车 的 相对 角度 的 演算 过 
程 。 值 得 注意 的 是 这 些 角 度 对 时 间 的 微分 取决 于 与 主 
车 相关 的 输入 变量 (ME), Un ZEUG Zr In fe 
的 话 ， 依 赖 于 B.， 还 依赖 于 其 前 方 拖车 的 相对 角度 。 
最 后 这 点 属性 是 由 于 J" 和 SS* 的 递归 结构 所 产生 的 。 
显然 ， 按 照 简 单机 器 人 的 方式 (如 17.3.2 节 、 


其 后 的 拖车 相对 角度 构成 的 矢量 。 男 外 ,我 们 用 
代表 系统 一 部 分 的 位 姿 ， 也 就 是 从 主 车 到 第 个 拖车 
的 位 姿 &; = (E 60, 6)", Hi (1Si<N,) 个 
拖车 的 第 7 个 轮子 的 运动 学 约束 能 用 以 下 几 点 来 
描述 : 

1) 参考 点 为 拖车 i-1 和 拖车 的 交点 。 

2) 我 们 定义 拖车 i 的 位 姿 为 &; ,该 矢量 由 各 个 
参考 点 的 坐标 ， 和 拖车 的 偏 角 (0-0, +… + 09.) 
组 成 。 

3) 轮子 相对 于 参考 点 的 位 置 在 极 坐标 下 描述 ， 
JEU SOR: aH BEUREN RRI B, 

4) 轮子 的 旋转 角度 为 wy。 

纯 滚 动 条 件 可 给 定 如 下 : 

( -sin(a, +Bi)cos(ay +B, ) l;cosB;) RCO + 


6, + 6) & +rp, =0 (17. 35) 
而 无 滑动 条 件 则 变 为 
cos( à; +B, )sin(a, * B; ) L;sinB;R(0 + 
O+ +0) ES (17. 36) 


拖车 i 的 位 姿 向 量 é&, 可 以 看 作为 & 和 其 前 面 的 拖车 的 
方位 角 的 函数 。 


&-g(£) 
这 表明 : 
» ôg; NO OE; " TM 
& cab + 2.399. = GLO Sai = Lo, 


(17.37) 
对 于 这 N 个 拖车 , 我们 可 以 在 无 滑动 条 件 中 
(17.36) 利用 此 式 ， 而 对 于 主 车 则 可 以 用 无 滑动 条 
件 ， 这 样 我 们 就 可 以 得 到 以 下 反映 系统 各 个 部 分 运动 
约束 的 方程 组 : 

J'(8,,0,0,,,0,)£* =0 (17.38) 
按照 第 17.3. 1 节 所 述 ， 我 们 可 以 推导 多 关节 型 机 器 
人 的 姿态 空间 运动 学 模型 ; 


é i =S* (B,,0,0, ,-,0,)m 


(17. 39) 


17.3.3 节 和 17.3.4 节 所 述 ) ， 完 全 可 以 推出 多 关节 
型 机 器 人 其 他 的 三 种 模型 。 

对 于 我 们 所 考虑 的 结构 空间 运动 学 模型 ， 其 
广义 矢量 有 所 有 变量 组 成 ， 包 括 拖车 轮子 的 旋转 
角 。 这 种 模型 是 姿态 空间 模型 在 考虑 纯 深 动 约 束 
下 的 扩展 (X (17.35) ) 。 通 过 适当 地 定义 9， 它 
还 可 以 表示 成 式 (17.19) 的 形式 。 结 构 空 间 动 力 
学 模型 可 通过 系统 的 拉 格 朗 日 方程 来 推导 ， 其 形 
如 式 (17.27)， 而 姿态 空间 动力 学 模型 ， 则 可 以 
通过 静态 状态 反馈 得 到 ， 这 就 再 一 次 和 姿态 空间 
运动 学 相关 ， 正 如 简单 移动 机 器 人 式 (17.33) 和 
xt (17.34) 。 


轮 式 机 器 人 的 结构 特性 


在 此 节 中 ,我 们 的 目的 在 于 从 控制 设计 的 角度 
来 讨论 以 上 轮 式 机 融 人 模型 的 结构 特性 。 因 为 在 大 
多 数 情况 下 ， 用 户 仅 对 机 器 人 的 位 姿 感 兴趣 ， 而 对 
其 内 部 变量 ( 比如 说 轮子 的 方位 角 ) 并 不 关心 ， 其 
中 最 受 关注 的 是 姿态 空间 运动 学 模型 和 动力 学 模型 。 
这 就 是 我 们 基于 姿态 空间 模型 来 讨论 结构 特性 的 
原因 。 


17.4.1 非 还 原 性 、 可 控 性 和 非 完 整 性 


1) 我 们 首先 提出 的 状态 空间 运动 学 模型 的 非 还 
原 性 的 问题 。 对 于 式 (17.33) 所 示 的 姿态 空间 运动 
学 模型 ， 我 们 首先 提出 一 个 问题 : 什么 是 还 原 性 。 如 
果 存 在 一 个 坐标 变换 ， 使 得 某 些 新 的 坐标 值 沿 运动 方 
向 为 0， 则 该 状态 模型 是 可 还 原 的 。 
对 于 形 如 式 (17.13) 和 式 (17.14) 的 无 浮 项 
非 线 性 动态 系统 ， 其 还 原 性 与 对 合 闭 包 A 相关， 而 4 
服从 以 下 分 布 A，A 在 局 部 坐标 系 里 可 表示 成 
A(z) =spanl colB(z) ] 
根据 Frobenius 理论 ， 可 得 到 以 下 著名 结论 : 4 


17. 4 
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系统 仅 在 满足 以 下 条 件 时 可 还 原 : 
dim(A) <dim(A) -1 

对 于 轮 式 移 动机 器 人 的 姿态 空间 运动 学 模型 ， 下 
列 性 质 能 够 满足 : 

对 于 姿态 空间 运动 学 模型 (17.33) z =B(z)u 

输入 矩阵 B(z) 满 秩 ， 也 就 是 

rank[ B(z) ] 28, +8, Yz 

对 合 分 布 A(z) 有 常 最 大 维 数 ， 也 就 是 ，dim A(z) = 
3+6.。 

作为 结果 ， 轮 式 机 器 人 的 姿态 空间 运动 学 模型 是 
非 还 原 的 。 这 是 一 个 坐标 的 自由 性 。 

这 个 性 质 有 男 一 个 与 姿态 空间 运动 学 模型 相关 的 
可 控 性 相关 的 结论 。 对 于 形 如 式 (17.13) 式 
(17.14) 的 无 浮 项 非 线 性 动态 系统 ， 其 强 代数 可 达 
性 与 对 合 分 布 A(z) 一 致 ， 而 该 对 合 分 布 有 常 最 大 维 
数 。 也 就 可 以 得 到 以 下 结论 ， 当 强 代数 可 达 性 的 秩 条 
件 满足 时 ， 则 系统 从 任意 配置 点 都 是 强 可 达 的 。 对 于 
这 样 的 无 浮 项 系统 ， 这 就 意味 着 其 可 控 性 。 实 际 上 ， 
这 意味 着 移动 机 器 人 总 是 能 够 在 有 限 的 时 间 里 从 任意 
初始 位 姿 包 驱动 到 任意 指定 位 姿 扣 ， 这 主要 是 通过 操 
纵 速度 控制 输入 w=(m COO 来 实现 。 最 后 ， 分 布 
A(z) 和 A(z) 维 数 的 不 同 在 于 : 

dim[ A(s) ] - dim[A(s)] = (3 +8,) - (8, +6,) = 
3 - 5,， 其 与 姿态 空间 运动 学 模型 的 非 完 整 性 相关 。 
如 果 其 差异 值 为 非 0 f (也 就 是 5 和 2) WK 
姿态 空间 运动 学 模型 被 称 之 为 非 完 整 的 。 如 果 5, = 
3， 也 就 是 移动 机 器 人 为 全 方位 移动 机 器 人 ， 则 其 姿 
态 空 间 运动 学 模型 为 完整 的 。 

2) 结构 空间 运动 学 模型 (17.23) 是 通过 把 内 
MEELA) 和 g(t) 加 入 到 其 姿态 空间 模型 中 得 到 
的 ， 且 形 如 : q -S(q)u. 

为 了 研究 系统 的 还 原 性 和 可 控 性 ， 我 们 必须 考虑 
以 下 两 个 分 布 : A Cq) = span[ col( $(9)) ] 和 其 对 合 


HE A, (9) 。 
即 有 
6,, +ô, 2 dim[ A, (9) ] <dim[ A, (q) ] <dim(q) 
=3+N+N, +N, 


我 们 定义 机 构 空间 运动 学 模型 的 非 完 整 性 度 
TOS: 
M - dim[ A, (q) ] - (8, +8.) 

M 代表 着 速度 约束 的 数目 ， 由 于 该 约束 是 非 可 
积 的 ， 因 此 无 论 怎样 选择 广义 坐标 都 不 可 能 从 结构 空 
间 表 达 式 中 消除 。 必 须 指出 的 是 ， 该 数目 依赖 于 轮 式 
机 避 人 的 特定 结构 ， 因 此 ， 即 使 是 属于 同一 类 的 两 个 


机 器 人 该 数目 也 无 需 一 定 相 等 。 在 另 一 方面 ， 对 于 选 
定 的 广义 坐标 系 ， 能 够 通过 积分 消除 掉 的 约束 等 于 
dim(q) 5 dim(A,(q)) 之 差 。 

可 以 验证 的 是 : 所 有 类 型 的 轮 式 机 器 人 其 结 
构 空 间 运 动 学 模型 都 是 非 完 整 的 (包括 全 方位 移 
动机 器 人 ) ， 也 就 是 其 非 完 整 性 不 等 于 0， 但 是 它 
是 可 以 还 原 的 。 更 进一步 的 是 ， 它 不 满足 强 可 大 
秩 条 件 。 

这 条 性 质 与 姿态 空间 运动 学 模型 的 非 还 原 性 并 不 
了 矛盾。 结构 空间 运动 学 模型 的 非 还 原 性 意味 着 至 少 存 
寿 一 个 光滑 的 函数 g(1) ， 其 中 至 少 包 括 一 个 变量 B, 
G) 和 g(t)， 能 够 在 满足 所 有 的 运动 学 约束 的 情况 
下 与 系统 的 运动 轨迹 一 致 。 

3) 在 17.3.3 节 和 17.3.4 节 中 ,我 们 已 经 看 到 
了 动力 学 模型 。 无 论 是 结构 空间 动力 学 模型 ， 还 是 姿 
态 空间 动力 学 模型 ， 均 与 其 对 应 的 运动 学 模型 相关 ， 
其 不 同 之 处 在 于 其 变量 仅 为 状态 矢量 的 一 部 分 。 这 就 
意味 着 存在 一 个 浮 项 ， 而 且 其 输入 矢量 场 是 恒定 的 。 
动力 学 模型 继承 了 相应 运动 学 模型 的 结构 特性 。 特 别 
的 是 ， 姿 态 空间 动力 学 模型 是 非 还 原 的 和 小 时 间 局 部 
可 控 的 。 


17.4.2 ”稳定 性 


显然 ， 任 意 绝 对 配置 点 (E pO REAREA 
空间 模型 的 一 个 平衡 点 。 平 衡 意味 着 机 器 人 静止 在 某 
个 位 置 ， 也 就 是 以 菜 给 定 姿 势 i， 其 方位 轮子 的 方 
位 角 为 给 定 的 B.， 并 且 其 速度 去 为 0。 
现在 ,我们 考虑 一 下 当 存在 反馈 控制 w(z) ， 并 
在 某 特定 点 z 能 够 使 移动 机 器 人 稳定 的 问题 。 

对 于 完整 机 器 人 (也 就 是 ， 全 方位 移动 机 器 人 ， 
其 状态 z 就 是 位 姿 矢量 &) ， 这 个 问题 不 值得 考虑 ， 因 
为 上 能 够 直接 通过 系统 输入 u 获得 。 辟 如 ， 我 们 设 
计 控 制 律 为 w(z) =B-:(z)4(z-z) ， 就 能 够 保证 得 到 
如 下 所 示 的 闭环 系统 

E -A(£-£) 

"AA ME A 满足 Hurwitz 条 件 时 ， 对 于 任意 平衡 点 
z 系统 是 指数 稳定 的 。 

对 于 运动 性 受 限 的 机 器 人 ( 非 完整 的 机 器 人 ) , 
情况 不 太 有 利 。 确 实 不 满足 所 谓 的 存在 光滑 时 变 稳定 
反馈 的 Brockett 必要 和 条件， 因为 (z, u) —B(z)u 的 
隐 射 不 在 平衡 点 的 领域 里 (RR 34.4.4), 

可 知 ， 对 于 运动 性 受 限 的 机 器 人 ( 非 完整 机 器 
A) 而 言 ， 仅 通过 一 个 连续 的 静态 时 变 状态 反馈 ， 
其 姿态 空间 运动 学 模型 是 不 稳定 的 。 然 而 ， 对 于 这 样 
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的 一 个 模型 ， 不 管 它 能 不 能 应 用 光滑 时 变 状态 反馈 或 
者 不 连续 反馈 来 稳定 。 这 个 性 质 由 其 相应 的 结构 空间 
动力 学 模型 所 继承 ,仅仅 通过 连续 的 静态 时 变 状 态 反 
馈 ， 动 力学 模型 也 是 不 稳定 的 。 


静态 状态 反馈 线性 化 


在 这 一 节 中 ， 我 们 分 析 对 于 其 姿态 空间 运动 学 模 
型 (17.33) 和 动力 学 模型 (17. 33，34) ， 存 在 一 个 
状态 反馈 ， 使 得 该 模型 能 够 被 全 部 线性 化 或 部 分 线性 
化 的 情况 。 

下 面 为 第 一 个 结论 。 姿 态 空间 运动 学 模型 

(17.33) 通过 光滑 静态 反馈 线性 化 后 所 得 到 的 最 大 
子 系统 维 数 为 5, + 85.。 而 动力 学 模型 (17.33, 34) 
经 光滑 静态 反馈 线性 化 后 所 得 到 的 最 大 子 系统 维 数 为 
2(6, +5.)。 
可 以 证 实 的 是 ， 姿 态 空间 运动 学 模型 的 最 大 可 线 
性 化 子 系统 是 通过 选择 足够 的 (565, +5.) ， 依 赖 于 > 
的 线性 化 输出 方程 来 获得 的 ， 但 仍 有 3 -6, 个 分量 未 
被 线性 化 。 同 样 ， 其 姿态 空间 动力 学 模型 的 最 大 可 线 
性 化 子 系统 的 维 数 为 205, +6.)， 与 线性 化 输出 方程 
的 数目 相等 。 

对 于 全 方位 移动 机 器 人 (有 完整 姿态 模型 的 
机 器 人 ) Bs, =3 和 6. =0。 上 面 所 述 的 性 质 表 
明 其 能 够 通过 静态 状态 反馈 完全 线性 化 。 与 此 相 
反 的 是 , 移动 性 受 限 的 机 器 人 ， 其 姿态 模型 仅 能 
部 分 线性 化 。 
动态 状态 反馈 线性 化 一 一 微分 平 
滑 性 

本 节 旨 在 说 明 一 下 能 够 通过 动态 状态 反馈 完全 线 
性 化 的 轮 式 机 器 人 的 姿态 空间 模型 。 显 然 ， 我 们 仅 考 
虑 运动 性 受 限 的 机 器 人 ， 因 为 正如 上 一 节 所 述 ， 全 方 
位 移动 机 器 人 能 够 通过 静态 状态 反馈 完全 线性 化 。 

考虑 一 个 以 广义 状态 空间 形式 给 出 的 非 线性 动力 
学 系统 ， 输 入 的 仿 射 为 : 


17.4.3 


17. 4.4 


z = f(z) + TO (17.42) 


UB, DSieR'; 输入 ue R”; 可 量 场 f 和 g, 是 光 
滑 的 。 
虽然 有 的 系统 通过 静态 状态 反馈 (对 于 运动 性 
受 限 的 机 器 人 ) 无 法 完全 线性 化 时 ， 然 而 通过 引进 
更 加 通用 的 动态 反馈 律 却 有 可 能 完全 线性 化 


u -a(z,y,o) 


. (17.43) 
X -a(z,y,0) 


UP, o 为 辅助 控制 输入 。 我 们 通过 选择 m 个 合适 
的 线性 化 输出 方程 来 获得 这 种 动态 反馈 
y, = 几 (z) ， (17. 44) 
我 们 将 所 谓 的 动态 扩展 算法 来 应 用 到 系统 式 
(17.42) ~ 式 (17.44) 。 这 种 算法 的 思想 在 于 通过 加 
入 积分 作用 , 来 延迟 某 些 输入 对 某 些 输出 的 影响 。 为 
了 让 其 他 的 输入 同时 能 够 起 到 作用 ， 并 且 期 望 能 够 扩 
展 得 到 一 个 解 看 系统 ， 其 形 如 
yt? =w, k=1,.…,m, (17.45) 
RP, y5' 间 yy 对 时 间 的 i 阶 导数 ; 六 表示 的 相对 
阶 数 ; w, 是 新 辅助 输入 。 为 了 获得 一 个 完整 的 线性 
化 ， 我 们 必须 有 一 个 n, 维 的 扩展 系统 


m 


b =n, 


其 扩展 状态 变量 z. = (z” Xx) 的 维 数 为 n.。 若 条 件 
(17.46) 满足 ， 则 
Espl) = cs x? c y, 
为 一 个 局 部 微分 同 胚 。 

能 够 通过 动态 扩展 算法 线性 化 的 系统 被 称 之 为 微 
分 平滑 系统 。 线 性 化 输出 y, =h; (z) 亦 被 称 之 为 平滑 输 
入 。 相 反 ， 微 分 平滑 性 指 的 是 能 够 通过 动态 状态 反馈 
线性 化 的 系统 。 简 单 地 说 ， 一 个 平滑 系统 ， 其 状态 和 
输入 能 够 表示 成 平滑 输入 和 它们 对 时 间 微 分 的 代数 
函数 。 

动态 状态 反馈 和 微分 平滑 性 的 这 两 个 相关 的 特 
性 ， 在 控制 设计 和 路 径 规划 问题 中 很 受 重视 。 运 动 受 
限 的 机 器 人 的 姿态 空间 运动 学 模型 和 动力 学 模型 是 微 
分 平滑 系统 直接 由 以 下 两 个 性 质 产 生 

1) EMA m RAMEE m +2 个 状态 的 可 控 
的 无 浮 项 系统 为 微分 平滑 系统 。 

2) 如 果 非 线性 系统 2 =/(z, u) 是 微分 平滑 的 ， 
则 其 扩展 系统 z =f(z, u), u =v 也 是 一 个 微分 平滑 
系统 ， 因 此 能 够 用 动态 反馈 完全 线性 化 。 


17.5 轮 式 机 器 人 的 结构 


轮 式 移 动机 器 人 有 多 种 设计 方式 。 与 单 体 移动 机 
项 人 设计 问题 相关 的 有 轮子 类 型 的 选择 、 轮 子 的 安装 
位 置 以 及 运动 参数 的 选择 。 设 计 目 标 依赖 于 其 运行 环 
境 和 任务 ， 以 及 机 器 人 的 初始 和 运行 成 本 。 在 这 一 节 
中 ， 根 据 轮子 的 数目 来 区 分 机 器 人 的 结构 ， 然 后 再 介 
绍 针对 通常 应 用 的 设计 的 特征 。 


17.5.1 单 轮机 器 人 
单 轮机 器 人 在 维持 其 平衡 的 动态 控制 器 的 情况 下 


i2l,.m 


(17.46) 


ytn-D) 
m 
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是 不 稳定 的 。 典 型 的 例子 是 单 轮 脚踏车 。 作 为 单 轮 车 
的 一 种 变种 ， 在 机 器 人 中 使 用 球 轮 驱 动 结构 能 够 提高 
其 侧 向 稳定 性 ， 见 参考 文献 [17.7] 。 

球 式 机 融 人 也 可 以 看 作 是 一 个 单 轮机 器 人 。 为 了 
提高 动态 稳定 性 ， 纺 纱 轮 结构 被 用 做 平衡 机 构 。 这 种 
方法 的 优势 在 于 其 高 机 动 性 和 低 滚动 阻抗 。 然 而 ， 单 
轮机 器 人 很 少 用 在 实际 系统 中 ， 因 为 控制 比较 困难 ， 


组 成 。 当 这 种 机 器 人 遇 到 楼 梯 时 ， 它 抬 起 前 轮 则 可 以 
把 楼 梯 。 其 最 大 的 问题 在 于 它 需 要 动态 控制 其 平衡 。 
倒立 摆 型 机 器 人 的 例子 可 在 参考 文献 [17.9] IS 
考 文献 [17.10] 中 找到 。 
三 轮机 器 人 


三 轮机 器 人 静态 稳定 且 结 构 简 单 ， 因 此 它 是 一 种 


17. 5.3 


并 且 通 过 纯 航 位 推算 法 来 估计 机 器 人 的 位 姿 是 不 可 行 
的 。 在 参考 文献 [17.8] 给 出 了 一 个 球形 机 器 人 的 
例子 。 


17. 5.2” 双 轮机 器 人 


一 般 而 言 ， 有 两 种 类 型 的 双 轮 机 器 人 ， 如 图 
17.6 所 示 。 图 17. 6a 为 一 个 自行 车 类 的 机 絮 人 。 一般 
而 言 ， 这 类 机 器 人 前 轮 控 制 方向 ， 后 轮 驱动 。 因 为 自 
行车 类 机 器 人 的 动态 稳定 性 随 着 其 速度 增加 而 增加 ， 
不 需要 平衡 机 构 。 这 类 机 器 人 的 优势 在 于 其 宽度 能 够 
大 大 降低 。 然 而 ， 自 行车 类 机 器 人 很 少 被 采用 ， 因 为 
在 静止 状态 下 ， 它 不 能 保持 其 姿态 。 图 17. 6b 所 倒立 
摆 型 的 机 器 人 是 一 个 两 轮 差 分 驱动 的 机 如 人 ， 当 其 重 
心 精确 地 在 轮轴 上 时 ， 它 有 可 能 维持 静 稳定 状态 。 然 
而 ， 通 常 还 是 要 用 到 动态 平衡 控制 的 ， 这 和 传统 的 倒 
立 摆 的 控制 问题 相同 。 


图 17.6 两 种 类 型 的 双 轮 机 器 人 
a) 自行 车 类 机 器 人 pb) 倒立 摆 型 机 器 人 


相对 于 多 于 三 轮 的 机 器 人 ， 双 轮机 器 人 的 斥 二 能 
够 大 大 减 小 。 倒 立 摆 类 型 的 双 轮 机 器 人 的 典型 应 用 是 
一 个 四 轮 的 机 器 人 ， 它 有 前 后 两 个 倒立 摆 连 接 在 一 起 


应 用 最 广泛 的 结构 。 根 据 单个 轮子 的 选择 类 型 不 同 ， 
这 类 机 器 人 有 很 多 种 设计 。17. 2. 1 中 所 介绍 的 各 种 
类 型 的 轮子 都 能 够 用 于 构成 三 轮机 器 人 。 在 这 一 节 
中 ,我 们 将 介绍 五 种 最 流行 的 设计 范例 (如 图 17.7 
所 示 ) : 中 双 轮 差分 驱动 ; Qi eI, @@ 瑞 士 轮 
驱动 的 全 方位 移动 机 器 人 ; @ 主 动 偏心 脚轮 驱动 的 全 
方位 移动 机 器 人 ; 名 转向 轮 驱 动 的 全 方位 移动 机 
at, 


1. 双 轮 差分 驱动 机 器 人 

双 轮 差分 驱动 机 器 人 是 最 通用 的 一 种 设计 ， 它 由 
两 个 主动 固定 轮 和 一 个 被 动 脚 轮 组 成 。 根 据 17.2.6 
的 命名 法 ， 这 类 机 器 人 可 以 归 为 (2，0) 类 机 还 
人 。 通 过 添加 一 个 被 动 脚轮 ， 它 能 扩展 成 一 个 四 轮机 
器 人 。 其 主要 的 优点 在 于 以 下 几 点 : 

1) 简单 的 机 械 结构 ， 简 单 的 运动 学 模型 以 及 低 
廉 的 装配 成 本 。 

2) 能 实现 0 转弯 半径 转弯 。 对 于 一 个 圆柱 形 的 
机 器 人 ， 通 过 扩展 机 器 人 的 半径 >， 其 无 障 空 间 很 容 
易 被 计算 出 来 。 

3) 其 系统 误差 很 容易 被 校正 。 

其 缺陷 在 于 : 

1) 在 不 规则 平面 或 曲面 上 很 难 运动 ， 当 它 在 不 
平 的 底面 上 运动 时 ， 若 一 个 轮子 没 和 地 面 保持 连接 ， 
则 它 的 方向 可 能 有 很 大 变化 。 

2) 仅 能 沿 两 个 方向 运动 。 

2. 同步 轮 驱动 机 器 人 

同步 轮 驱 动机 器 人 能 够 用 偏心 或 者 不 偏心 的 定向 
轮 构 成 。 每 个 轮子 的 转向 或 者 驱动 运动 通过 链条 或 者 
传动 带 耦 合 在 一 起 ， 这 些 运动 是 同步 驱动 的 ， 所 以 这 
些 轮子 的 方向 总 是 同 向 的 。 同 步 驱动 机 器 人 的 的 运动 
学 模型 和 单 轮机 器 人 ， 也 就 是 与 (1，1) 类 机 器 人 
是 等 价 的 。 因 此 ， 全 方位 运动 ， 也 就 是 ， 通 过 控制 方 
向 轮 的 方向 到 指定 速度 方向 来 控制 机 器 人 沿 任意 方向 
运动 。 然 而， 轮子 底盘 的 方位 不 能 改变 。 有 些 情况 下 
会 采用 一 个 转动 塔 来 改变 机 体 的 方位 。 同 步 驱动 的 机 器 
人 的 最 大 好 处 在 于 其 全 方位 运动 能 力 能 够 通过 两 个 驱 
动 絮 就 可 以 得 到 。 
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被 动 脚轮 


图 17.7 五 种 三 轮机 器 人 设计 范例 


a) 双 轮 差分 驱动 b) 同步 轮 驱 动 


c) 瑞士 轮 驱 动 的 全 方位 移动 机 器 人 


d) 主动 偏心 方向 轮 驱 动 的 全 方位 移动 机 器 人 e) 转向 轮 驱 动 的 全 方位 移动 机 器 人 


因为 其 机 械 结构 保证 了 其 同步 转向 和 驱动 运动 ， 
所 以 其 运动 控制 相对 简单 。 其 他 优点 ， 比 如 里 程 数据 
相对 精确 、 各 个 轮子 的 驱动 力 比 较 均 匀 。 这 种 方式 的 
缺点 可 以 总 结 为 

1) 复杂 的 机 械 结 构 。 

2) 链条 传动 中 如 果 存 在 掉 链 或 者 斜 拉 的 情况 ， 
各 个 轮子 将 有 速度 差异 。 

3) 为 了 获得 全 方位 运动 ， 由 于 分 完整 约束 ， 在 
运动 之 前 ， 轮 子 的 方向 要 转 到 期 望 的 方向 上 。 

3. 瑞士 轮 驱动 的 全 方位 移动 机 器 人 

根据 17. 2.6 节 所 给 出 的 命名 法 ， 装 有 瑞士 轮 的 
全 方位 移动 机 器 人 属于 (3, 0) 类 。 制 造 一 个 全 方 
位 移动 机 器 人 至 少 需要 三 个 瑞士 轮 。 

使 用 瑞士 轮 的 最 大 好 处 在 于 很 容易 构造 一 个 全 
方位 移动 机 器 人 。 构 造 一 个 完整 的 全 方位 移动 机 天 
人 至 少 需 要 三 个 瑞士 轮 。 因 为 建造 全 方位 移动 机 融 
人 能 够 不 用 主动 驱动 的 方向 轮 组 ， 在 机 械 结构 上 相 
应 的 主动 驱动 部 位 可 以 简化 。 然 而 ， 轮 自 的 机 械 结 


构 变 得 有 点 复杂 。 瑞 士 轮 的 缺点 在 于 其 运动 过 程 中 
的 不 连续 接触 导致 垂直 方向 上 的 振动 。 为 了 解决 这 
个 问题 ， 相 关 研 究 者 提出 了 很 多 机 械 结构 ， 可 在 参 
考 文献 [17.11] 和 [17.12] 中 看 到 相关 的 例子 。 
另 一 个 确定 就 是 它 的 轮子 相对 于 传统 轮子 更 容易 磨 
损 。 在 参考 文献 [17. 13] 中 可 以 看 到 使 用 瑞士 轮 的 
例子 。 

4. 主动 偏心 脚轮 驱动 的 全 方位 移动 机 器 人 

通过 至 少 两 个 主动 偏心 脚轮 能 够 制造 一 个 完整 的 
全 方位 机 器 人 ， 这 种 机 器 人 亦 属 于 (3, 0) 型 。 通 
过 控制 ， 这 种 机 器 人 能 够 产生 绝对 线 速 度 和 角速度 ， 
而 不 用 考虑 轮子 的 方位 。 由 于 机 器 人 采用 了 传统 的 轮 
子 ， 瑞 士 轮 的 许多 缺陷 ， 壁 如 纵向 振动 和 不 耐用 的 问 
题 ， 均 得 到 了 很 好 的 解决 。 参 考 文献 [17.14] 中 可 
以 看 到 一 个 相应 的 例子 。 这 类 机 器 人 的 缺陷 主要 可 以 
总 结 为 以 下 几 点 : 

1) 轮子 与 地 面 的 接触 点 相对 于 机 器 人 底盘 是 不 
固定 的 ， 当 轮子 间 的 距离 太 小 时 ， 其 有 可 能 不 稳定 。 
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2) 如 果 机 器 人 切换 到 其 当前 运动 方向 的 反方 向 
运动 ， 轮 子 的 方向 将 剧烈 变化 。 这 被 称 之 为 购物 车 效 
应 。 这 将 产生 不 连续 的 高 转向 速度 。 

3) 如 果 电 动机 直接 安装 在 轮子 上 ， 当 轮子 转 
向 时 ,电动 机 的 出 线 有 可 能 缠 在 一 起 。 为 了 避免 
这 种 现象 ， 一 般 要 使 用 安装 在 机 器 人 底盘 的 齿轮 
传动 机 构 。 在 这 种 情况 下 ， 其 机 械 结 构 变 得 相当 
复杂 。 

4) 如 果 轮 子 装 有 两 个 以 上 的 主动 偏心 脚轮 ， 则 
使 用 四 个 以 上 的 驱动 器 。 因 为 完整 的 全 方位 机 器 人 系 
统 所 需 最 少 驱动 器 的 数目 为 3 个 ， 所 以 这 是 一 个 过 驱 
动 系统 。 因 此 ， 这 些 驱 动 器 的 控制 必须 以 同步 的 方式 
精确 控制 。 

5. 导向 轮 驱动 的 全 方位 机 器 人 

非 偏 心 导向 轮 也 被 用 于 制造 全 方位 移动 机 器 人 ， 
至 少 需要 两 个 这 样 的 模块 。 主 动 偏心 脚轮 和 非 偏向 
导向 轮 的 重大 差异 在 于 非 偏 心 脚轮 总 是 要 与 期 待 的 
速度 方向 保持 一 致 ， 正 如 逆向 运动 学 计算 出 来 的 一 
样 。 这 就 意味 着 这 种 机 器 人 是 非 完整 的 和 全 方位 的 ; 
它 是 一 种 (1,2) 型 的 机 器 人 。 参 考 文献 [17.15] 
提出 了 其 控制 的 问题 。 其 机 械 结构 的 缺陷 和 主动 仿 
心 脚轮 类 似 〈 即 很 多 驱动 器 和 复杂 的 机 械 结构 ) ， 
因为 在 很 多 情况 下 ， 了 驱动 电动 机 直接 连接 在 驱动 轴 
上 面 , 为 了 避免 缠 线 问题 ， 其 允许 转动 的 角度 是 有 
限 的 。 

除了 上 面 所 述 几 种 设计 外 ， 三 轮机 器 人 还 有 很 
多 种 设计 方案 。 它 们 能 够 用 17. 1 节 中 所 给 出 的 方法 
分 类 和 分 析 。 这 些 设计 方案 都 可 以 扩展 成 四 轮机 器 
人 以 提高 其 稳定 性 。 附 加 的 轮子 可 以 是 被 动 轮 ， 这 
样 可 以 避免 增加 运动 约束 。 当 然 ， 主 动 轮 也 可 以 加 
进去 ,但 是 必须 通过 求解 逆向 运动 学 的 问题 来 控制 。 
四 轮机 器 人 需要 悬浮 来 保证 轮子 和 地 面 的 接触 ， 从 
而 避免 当地 面 不 平 的 时 候 有 某 些 轮子 在 运动 时 离开 
地 面 。 


17.5.4 四 轮机 器 人 


在 各 种 类 型 的 四 轮机 器 人 中 ,我们 主要 关注 车 型 
机 需 人 。 这 种 类 型 的 机 器 人 的 前 轮 必 须 同 步 转向 ， 并 
且 其 瞬时 旋转 中 心 是 相同 的 。 因 此 ， 这 种 类 型 的 机 顺 
人 在 运动 学 上 和 单 轮机 器 人 是 等 价 的 ， 可 划 为 
(1，1) 类 机 器 人 。 车 式 机 絮 人 的 最 大 好 处 在 于 其 在 
高 速 运动 时 是 稳定 的 。 然 而 ， 它 的 机 械 结构 相对 复杂 
了 一 点 。 如 果 是 后 轮 驱 动 ， 需 要 用 差 速 齿 轮 来 保证 转 
弯 时 驱动 轮 为 纯 滚动 。 如 果 前 轮 的 转向 角 不 能 达到 
90 度 ， 则 其 转弯 半径 为 非 0 的 。 因 此 ， 在 拥挤 环境 


= 


的 泊 车 运动 控制 变 得 比较 困难 。 
17.5.5 轮 式 机 器 人 的 特殊 应 用 


1. 多 关节 型 机 器 人 

正如 17.3.5 节 所 述 ， 一 个 独立 的 机 器 人 能 够 被 
扩展 成 多 关节 型 机 器 人 ， 这 种 多 关节 型 的 机 器 人 由 
机 器 人 和 拖车 组 成 。 机 场 的 行李 传输 拖车 系统 为 其 
典型 应 用 。 通 过 使 用 拖车 ， 移 动机 器 人 获得 了 很 多 
好 处 。 比 如 ， 可 以 根据 服务 任务 的 要 求 重 新 配置 其 
结构 。 

17.3.5 节 中 给 出 了 一 个 牵引 车 带 多 个 拖车 的 通 
常设 计 ， 这 是 多 关节 机 右 人 的 最 简单 设计 。 从 控制 的 
角度 而 言 ， 有 些 主 要 因素 是 很 清楚 的 ， 包 括 可 控 性 的 
证 明 ， 可 依据 规范 形式 ， 如 链 式 形式 来 设计 开 环 和 闭 
环 控 制 器 。 拖 车 系统 的 设计 问题 主要 就 是 轮子 类 型 的 
选择 以 及 连 杆 参数 的 决策 。 在 实际 应 用 中 ， 帮 拖车 能 
沿 着 牵引 车 的 路 径 运动 ， 会 带 来 很 多 好 处 。 通 过 对 拖 
车 的 被 动 转向 操纵 机 构 的 特殊 设计 ， 拖 车 的 运行 路 径 
能 够 很 好 地 和 牵引 车 的 运行 路 径 吻 合 ， 具 体 可 见 参考 
文献 [17. 16] 。 

另 一 方面 ， 亦 可 以 用 到 主动 拖车 。 有 两 种 主动 拖 
车 ， 第 一 种 方法 是 驱动 拖车 的 轮子 ， 它 和 其 他 车 的 连 
接 需 是 被 动 的 。 通 过 使 用 这 种 类 型 的 主动 拖车 ， 可 以 
实现 精确 的 路 径 控制 。 第 二 种 方法 是 驱动 连接 器 ， 拖 
车 的 轮子 是 被 动 驱动 的 。 通 过 对 连接 器 的 驱动 控制 ， 
机 器 人 可 以 在 不 对 轮子 驱动 的 情况 下 也 进行 运动 ， 比 
如 蛇行 运动 。 作 为 一 个 备 选 设 计 ， 我们 可 以 使 用 一 个 
主动 驱动 的 蓉 形 关节 来 连接 拖车 ， 以 此 来 抬 起 邻近 的 
拖车 。 通 过 允许 纵向 运动 ， 一 个 拖车 系统 就 能 够 仆 楼 
梯 和 越过 粗 烽 地形。 主动 驱动 的 拖车 系统 可 在 参考 文 
献 [17.17] 中 看 到 。 

2. 混合 式 机 器 人 

轮 式 机 器 人 的 基本 困难 在 于 它 仅 能 在 平面 上 使 
用 。 为 了 克服 这 个 困难 ， 我 们 常常 将 轮子 连接 到 特殊 
的 连 杆 机 械 结构 上 面 。 每 一 个 轮子 均 由 一 个 独立 的 驱 
动 器 驱动 ， 并 且 连 杆 机 械 结构 使 得 机 器 人 能 够 适应 不 
平 的 地 面 的 情况 。 参 考 文献 [17.18] 中 可 看 到 这 种 
机 器 的 典型 应 用 ， 我 们 可 以 将 之 理解 为 腿 式 机 器 人 和 
轮 式 机 器 人 的 结合 物 。 

另 一 种 混合 型 机 器 人 的 例子 是 同时 装 有 履带 和 轮 
子 的 机 器 人 人， 履带 和 轮子 各 有 其 优 缺 点 。 轮 式 机 器 人 
的 能 量 效率 高 ， 然 而 ， 履 带 是 机 器 人 能 够 穿越 粗糙 的 
地 形 。 因 此 ， 一 个 混合 型 机 器 人 能 依据 环境 条 件 选 择 
其 驱动 机 构 ， 尽 管 装配 成 本 增加 了 。 
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17.6 结论 


轮 式 移动 机 器 人 的 具体 实现 方式 是 无 限 的 ， 取 决 
于 轮子 的 数目 、 类 型 、 实 现 、 几 何 参 数 和 驱动 系统 。 
这 一 章 中 描述 了 几 种 实现 方式 。 尽 管 我 们 将 轮 式 驱动 
移动 机 器 人 仅仅 分 为 五 个 大 的 类 型 。 每 种 类 型 机 器 人 
的 姿态 空间 模型 (运动 学 和 动力 学 ) 有 相同 的 结构 。 
这 点 对 于 基于 模型 的 控制 器 设计 方法 是 尤为 重要 的 ， 
E 如 34 章 所 述 。 
有 关 移 动 性 的 讨论 以 及 模型 的 推导 均 基 于 轮子 与 
地 面 接触 的 假设 : 每 个 轮子 均 满 足 纯 深 动 和 无 滑动 条 
件 。 这 些 条 件 所 带 来 的 运动 学 约束 组 成 了 分 析 的 基 
础 ， 并 与 模型 的 非 完整 性 。 因 此 ， 所 有 基于 模型 的 控 
制 设计 均 依 赖 与 同样 的 假设 。 

这 些 假 设 是 对 实际 系统 的 理想 化 抽象 : 运动 学 约 
束 不 一 定 完全 满足 ， 存 在 与 接触 力 上 相关 局 部 的 滑动 
效应 。 这 样 就 立即 产生 了 一 个 问题 ， 这 些 模型 的 可 信 
生 有 和 多少? 

奇异 摄 动 方法 表明 : 滑动 效应 能 够 被 看 做 快 
动力 学 效应 ， 相 对 于 移动 机 器 人 的 全 局 运动 的 动 
力学 效应 ， 其 特征 时 间 是 很 短 的 ， 以 致 能 够 被 忽 
略 ， 至 少 是 在 分 析 和 控制 设计 中 。( 见 参考 文献 
[17.1])。 
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王 奇 志 


微型 机 器 人 (Microrobotics) 领域 涵盖 从 毫米 
到 微米 物体 的 机 器 人 操作 和 自主 机 器 人 实体 的 设计 
和 制造 。 纳 米 机 器 人 (Nanoroboties) 用 同样 的 方 
式 定义 ， 只 是 其 大 小 比 一 个 微型 机 器 人 更 小 。 在 微 
米 和 纳米 尺度 上 对 物体 进行 定位 、 定 向 和 操作 的 能 
力 对 于 包括 微型 和 纳米 机 器 人 在 内 的 微米 和 纳米 系 
统 是 一 种 非常 有 前 景 的 方法 。 

本 章 对 微型 和 纳米 机 器 人 的 最 新 研究 进行 了 概 
述 。 概 括 介 绍 了 规模 影响 、 驱 动 、 传 感 和 制造 ， 重 
点 介绍 微型 和 纳米 机 器 人 操作 系统 及 它们 在 微型 装 
配 、 生 物 技术 中 的 应 用 和 微机 电 系 统 和 纳 机 电 系 统 
(MEMS/NEMS) 的 建造 和 描述 。 材 料 科学 、 生 物 
技术 和 微 - 纳 电子 也 将 都 受益 于 机 器 人 这 些 领域 的 
进展 。 
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18.1 概述 


最 近 几 十 年 机 器 人 领域 的 进展 极 大 地 提升 了 我 
们 人 类 在 各 种 领域 探索 、 感 知 、 理 解 和 操作 世界 的 
能 力 ， 这 些 范 围 上 至 太阳 系 的 边缘 ， 下 至 海底 ， 小 
至 单个 原子 ， 如 图 18. 1 所 示 。 在 这 个 量 级 的 低 端 ， 
技术 已 经 转向 拥有 对 更 多 物质 结构 的 控制 权 ， 这 表 
明 通 过 对 原子 进行 逐个 排列 以 完全 彻底 控制 分 子 结 
构 是 完全 可 能 的 ， 正 如 Richard Feynman 在 1959 年 
在 他 预言 性 的 文章 关于 微型 化 问题 首次 提出 的 
那样 (* N : 

我 想 谈 的 是 关于 在 一 个 更 小 层次 上 操作 和 控制 物 
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体 的 问题 。 一 一 我 不 怕 考 虑 最 后 的 问题 关于 是 否 ， 最 
终 一 一 在 遥远 的 未 来 我 们 以 我 们 想 要 的 方式 可 以 任意 
安排 原子 : 就 是 原子 ， 以 任何 方式 ! 

他 断言 :“ 在 原子 水 平 上 ， 我 们 将 会 拥有 新 的 力 
量 、 新 的 可 能 性 、 新 的 影响 。 制 造 和 再 生 材 料 是 非常 
不 同 的 。 在 我 看 来 ， 物 理学 原理 并 不 排除 对 物质 原子 
实行 逐个 控制 的 可 能 性 ”。 

现 如 今 ， 这 种 技术 被 称 为 纳米 技术 。 

Feynman 所 提 到 的 伟大 未 来 在 20 世纪 80 年 代 开 
始 实 现 。 他 (对 纳米 技术 ) 的 一 些 潜 在 梦想 都 已 变 
为 现实 ， 而 其 他 的 也 正在 积极 地 进行 中 。 Feynman 预 
言 雇佣 一 个 微型 机 器 人 操作 手 (一 个 主 - 仆 系 统 ) HE 
行 自 下 而 上 的 微小 机 器 的 制作 (操作 、 装 配 等 ) ; 一 
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m, 


第 18 E 


微型 和 纳米 机 器 人 327 


图 18.1 微米 和 纳米 尺度 上 的 机 器 人 探索 


个 这 样 的 设备 被 他 描述 为 “把 外 科 医 生硬 下 去 ”， 他 
把 它 归功 于 他 的 朋友 Albert R. Hibbs。 他 还 设想 我 们 


且 越 来 越 小 的 微机 器 人 设备 的 发 展 及 其 迅速 。 无 线 不 
受 控制 的 微型 机 器 人 能 够 探索 和 修复 我 们 的 身体 


可 以 “建造 一 个 数 亿 的 微小 工场 ， 它 们 互相 建立 模 
型 ， 在 制作 的 同时 进行 种 压 、 钻 孔 等 ”。 从 20 世纪 六 
七 十 年 代 将 看 似 很 远 的 概念 变 成 为 现实 到 20 世纪 80 
年 代 后 期 微机 电 系统 的 出 现 ， 微 型 和 纳米 级 机 器 人 的 
研究 取得 了 非常 大 的 进展 。 这 些 固件 以 微 加 工 的 微 电 
动机 和 微 夹 持 咒 的 形式 存在 ， 它 们 都 是 在 一 个 硅 忆 片 
上 制造 成 的 多 草 硅 构成 的 21。 在 20 世纪 80 年 代 后 
期 和 20 世纪 90 年 代 初 ， 涌 现 了 大 量 关 于 如 何 能 实现 
基于 MEMS 的 装 有 微 电 动机 的 微机 器 人 设备 及 应 用 
的 文章 。 现 在 各 种 各 样 的 微型 机 器 人 设备 在 各 个 不 同 
领域 有 着 新 的 应 用 。 

在 工业 中 ， 对 微型 机 器 人 感 兴趣 的 领域 包括 装 
配 、 特 征 描述 、 检 查 和 维护 及 微 定 位 (利用 微 光学 
芯片 ， 微 透镜 和 楼 镜 来 进行 定位 ) 。 许 多 这 些 应 用 都 
需要 自动 化 处 理 和 在 这 些 亚 微米 精度 范围 内 组 装 小 
零件 


o 


其 他 重要 领域 , 包括 生物 学 ( 操作、 收集、 分 
类 和 组 合 细胞 一 "1 ) 和 医疗 技术 ”1 。 在 手术 中 ， 
可 操纵 导管 和 内 宇 镜 的 使 用 具有 非常 大 的 吸引 力 ， 并 


(“ 香 咽 式 外 科 医 生 ”) ， 这 种 机 融 人 的 出 现 仅仅 是 一 
个 时 间 问 题 。 实 际 上 ， 使 用 无 线 胶 赛 〈 摄 像 头 丸 ) 
的 内 视 镜 已 经 出 现在 市 场 上 ， 这 样 内 视 镜 可 以 在 整个 
省 化 道内 妾 镜 成 像 ， 而 这 些 利用 标准 的 方法 是 实现 不 
了 的 。 磁 转向 或 者 爬行 方式 的 运动 对 于 一 些 设备 来 说 
是 一 种 可 行 的 方法 。 医 生 可 以 操作 固定 在 药丸 上 的 摄 
像 头 和 其 他 驱动 器 对 感 兴趣 的 但 是 超出 内 妾 镜 活检 的 
范围 的 区 域 进行 视觉 检查 。 

纳米 级 机 器 人 学 是 下 个 阶段 小 型 化 操作 纳米 级 
物体 的 代表 。 纳 米 机 器 人 学 是 在 纳米 级 别 对 机 器 人 
FFWR, AKAN BLA A, BURA a A 
和 拥有 在 纳米 分 辩 率 下 操作 纳米 物体 的 大 型 机 器 人 ， 
即 纳米 机 器 人 机 械 手 。 纳 米 型 机 如 人 领域 汇集 了 多 
门 学 科 ， 包 括 用 于 生产 纳米 机 器 人 的 纳米 加 工 过 程 、 
纳米 执行 器 、 纳 米 传 感 器 ， 以 及 在 纳米 级 别 上 的 物 
理 建 模 。 纳 米 型 机 器 人 的 操作 技术 ， 包 括 纳米 大 小 
零 部 件 的 装配 、 生 物 细 胞 或 者 分 子 的 操控 、 用 来 完 
成 这 些 任 务 的 各 种 机 器 人 类 型 和 构造 纳米 机 器 人 部 
件 的 技术 。 


E 


328 第 2 篇 


机 器 人 结构 


随 着 21 世纪 的 到 来 ， 纳 米 技术 对 人 类 健康 、 财 
富 和 安全 性 的 影响 预计 将 超过 20 世纪 抗生素 、 集 成 
电路 和 人 造 高 分 子 化 合 物 三 者 对 人 类 影响 的 总 和 。 例 
如 ，1998 年 N. Lane 提出 “如 果 问 我 哪个 科学 和 工程 
领域 将 最 可 能 产生 突破 ,我 的 回答 是 纳米 科学 和 工 
程 ” 。 纳 米 技术 所 带 来 的 巨大 的 科学 与 技术 机 会 激发 
了 纳米 世界 的 广泛 探索 和 引发 了 一 个 激动 人 心 的 全 球 
3&4, 2000 年 美国 政府 出 版 的 “国家 纳米 技术 计划 ” 
加 速 了 这 一 研究 的 发 展 。 如 果 Drexler 通过 机 械 合 成 
基于 自 复制 分 子 装 配器 的 机 器 阶段 纳米 系统 能 够 实 
现 ， 纳 米 机 器 人 将 会 使 纳米 技术 发 挥 很 重要 的 作用 ， 
并 可 能 最 终 成 为 纳米 技术 的 核心 部 分 。 

在 20 123 80 年 代 ， 扫 描 隧 道 电子 显微镜 从 根本 
上 改变 了 我 们 与 单个 原子 和 分 子 的 互动 方式 。 近 端 探 
测 方法 的 本 质 ， 促 进 了 对 传统 显 微 成 像 之 外 的 纳米 世 
界 的 探索 。 扫 描 探 针 使 得 我 们 在 单个 分 子 、 原 子 和 原 
子 的 聚合 处 进行 操作 ， 提 供 了 在 制造 最 终极 限 情况 下 
的 有 力 工具 。 

STMs 和 其 他 的 纳米 机 械 手 都 是 利用 了 自 下 而 上 
策略 的 非 分 子 设备 。 尽 管 在 一 个 时 刻 只 进行 一 个 分 子 
反应 用 于 做 大 量 的 产品 是 不 切实 际 的 ,但 它 有 望 提供 
下 一 代 的 纳米 型 机 械 手 。 更 重要 的 是 ， 通 过 纳米 操作 
能 够 实现 直接 装配 分 子 或 超大 分 子 以 构造 更 大 的 纳米 
结构 。 通 过 纳米 操作 制造 的 产品 可 以 通过 自 下 而 上 策 
略 的 第 一 步 生 产 出 来 ， 这 些 组 装 的 产品 被 用 来 自 组 装 
成 纳米 机 器 。 
纳米 机 器 人 操作 的 一 个 最 重要 的 应 用 是 纳米 机 器 
人 的 装配 。 但 现在 看 来 ， 在 装配 的 自我 复制 能 力 实现 
之 前 ， 从 原子 开始 的 化 学 合成 和 自 组 装 的 组 合 都 是 必 
要 的 ; 由 于 热 运 动 分 子 群体 能 够 很 快 进行 自 组 装 ， 
此 它们 可 以 探索 自己 所 处 的 环境 ， 并 找到 (RE) 
互补 性 分 子 。 由 于 和 蛋白质 在 自然 的 分 子 机 器 中 起 到 的 
关键 作用 ， 因 此 它们 是 自我 组 装 人 造 分 子 系统 早期 阶 
段 的 重要 组 成 部 分 。Degradol 2 fas T iei n] Dr 
成 固体 分 子 物质 的 蛋白 质 链 的 可 能 性 。 在 制造 人 工 酶 
和 其 他 相对 较 小 的 分 子 方面 也 取得 了 进展 ， 这 些 人 工 
酶 就 像 天 然 蛋 白质 表现 出 来 的 功能 一 样 。 一 些 用 于 自 
组 装 自 下 而 上 的 策略 似乎 是 可 行 的 天 2 。 化 学 合成 、 
自 组 装 、 超 分 子 化 学 使 人 们 有 可 能 从 纳米 级 构建 相对 
更 大 的 组 件 。 纳 米 机 器 人 操作 服务 作为 一 种 混合 方法 
的 基础 通过 构造 小 的 单元 并 装配 成 更 复杂 的 系统 来 构 
建 纳 米 设备 。 

未 来 纳米 机 器 人 的 形式 和 它们 将 完成 什么 样 的 
皇 务 现在 还 不 明确 。 然 而 ， 可 以 确定 的 是 纳米 技术 
在 制造 智能 传感器 、 执 行 器 和 小 于 100nm 的 系统 方 
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面 取得 了 较 大 进展 。NEMS 纳 机 电 系 统 将 会 是 用 来 
制造 未 来 纳米 机 器 人 及 其 组 件 的 工具 ， 而 制造 的 这 
些 组 件 将 用 于 开发 纳米 机 嚣 人。 将 设备 的 尺寸 缩 至 
纳米 单位 带 来 了 很 多 机 会 ， 例 如 利用 纳米 工具 操纵 
纳米 物体 ， 在 飞 克 范围 内 测量 质量 ， 在 微 牛顿 范 填 
感知 力 的 大 小 ， 还 包括 千 兆 赫 效 的 运动 等 。 这 些 能 
FRB FAS K NOK Las A Al NEMS 系统 来 实现 。 
NEMS 系统 和 纳米 机 器 人 组 件 是 纳米 机 器 人 操纵 的 
产品 。 由 于 这 一 发 展 大 型 纳米 机 器 人 机 械 手 将 会 缩 
小 其 尺寸 ， 因 此 这 也 将 会 使 机 器 人 的 机 械 手 和 其 他 
形式 的 纳米 机 器 人 纳米 化 。 所 有 这 一 切 形成 纳米 机 
器 人 研究 领域 。 

本 章 将 重点 放 在 微型 和 纳米 机 器 人 上 ， 其 中 包括 
在 微型 和 纳米 范围 上 的 驱动 、 操 纵 和 装配 。 机 器 人 这 
一 领域 的 主要 目标 就 是 提供 有 效 的 技术 用 于 微米 - 28 
米 世 界 的 探索 实验 ， 并 且 从 机 器 人 研究 的 角度 推进 这 
一 研究 范围 。 


18.2 规模 


18.2.1 物体 的 尺寸 


我 们 可 以 观察 的 范围 是 10-” ( 普 朗 克 长 度 ) ~ 
10°m, 一 个 纳米 单位 是 10”m， 是 最 小 原子 如 氢 和 
碳 原子 的 10 7, Lum 和 可 见 光 的 平均 波长 相差 无 几 。 
lmm， 一 个 针头 的 大 小 ， 是 通常 采用 传统 的 加 工 技术 
所 能 达到 的 最 小 尺寸 。 从 毫米 到 纳米 尺度 范围 是 一 百 
万 〈 见 图 18.1) ， 这 也 是 目前 从 最 大 的 摩天 大 楼 到 传 
统 的 最 小 机 械 零 件 大 小 的 范围 。 这 使 得 新 技术 差不多 
跨越 了 6 个 数量 级 。 如 果 工 表示 一 个 标准 长 度 ， 
0. Inm 表示 原子 长 度 ，2m 表示 一 个 人 的 高 度 , LA 
量程 范围 就 是 2 x 10"。 如 果 用 来 表示 面积 ，0. lnm x 
0. Inm 和 2m x 2m, L? 的 范围 为 4 x10”。 由 于 体积 
D 是 由 边区 围 成 ， 因 为 原子 的 大 小 为 0. lnm， 因 此 在 
8m 的 体积 中 ， 原 子 的 个 数 为 8 x 10" 个 ， 而 阿 伏 人 
德 罗 常数 为 6. 022 x 103 ，lmol Br ECT GE, (Bri 
原子 为 "C， 它 们 的 密度 就 为 1.99 x 10 kg/m? 。 纳 米 
技术 最 主要 的 一 个 工具 就 是 测量 各 种 各 样 属性 的 大 
小 ， 如 从 1mm 到 lnm 的 长 度 范围 。 

一 个 设备 中 的 原子 数 为 天 。 在 微米 尺度 上 的 唱 
体 管 包含 10”* 个 原子 ， 而 在 纳米 尺度 上 L/L=10”，， 
它 包含 有 1000 个 原子 ， 这 对 于 保持 其 功能 来 说 可 能 
太 小 。 通 常情 况 下 ， 我 们 会 在 三 维 空间 中 的 各 方向 进 
行 等 大 小 缩放 。 然 而 ， 在 一 维 或 者 二 维 的 方向 上 缩放 
大 小 才 是 有 用 的 ， 如 将 一 个 立方 体 缩放 为 一 个 2 维 的 
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板块 a, 或 者 一 维 的 管子 , 或 者 是 纳米 线 的 截面 积 
a^ , 0 维 用 来 表示 在 三 维 中 各 个 方向 都 很 小 的 物体 ， 
其 体积 是 a 。 在 电子 学 中 0 维 物体 (PERH a 
的 纳米 大 小 的 半导体 ) 被 叫做 量子 点 (QD) 或 者 是 
人 造 原子 ， 这 是 因为 它 的 电子 态 数 很 少 并 且 其 能 源 大 
HALES, ， 看 起 来 像 是 一 个 原子 的 电子 态 。 


18.2.2 微米 - 纳米 级 上 的 主导 物理 学 


在 微观 - 纳米 尺度 上 的 主导 物理 学 与 宏观 上 的 物理 
学 有 着 显著 的 不 同 。 当 物体 的 大 小 小 于 1000umi ”| 时 ， 
表面 和 分 子 间 的 作用 力 ， 如 来 自 于 表面 张力 的 粘 附 
力 、 范 德 华 力 、 静 电 作用 等 变 得 更 加 重要 ， 而 不 再 是 
物体 间 的 引力 。 尽 管 经 典 的 牛顿 定理 能 够 说 明 当 尺寸 
缩小 至 10nm (100A) 的 行为 的 变化 ,但 是 变化 范围 
还 是 很 大 的 。 因 此 ， 有 许多 重要 的 物理 化 学 性 质 发 生 
了 巨大 的 变化 ， 如 共振 频率 。 而 这 也 将 促使 完全 不 同 
的 新 的 应 用 的 产生 。 
纳米 技术 最 大 的 挑战 性 问题 就 是 如 何 理解 和 
利用 那些 在 经 典 尺度 范围 边缘 的 物理 行为 变化 。 
尺度 边缘 恰恰 就 是 原子 和 分 子 尺度 大 小 ， 在 该 尺 
度 范围 内 ， 纳 米 物理 学 可 以 用 来 代替 经 典 物 理学 
定理 。 现 代 物 理 ， 包 括 量子 力学 ， 作 为 描述 纳米 
尺度 物质 的 物理 学 理论 ， 是 一 门 发 展 成 熟 的 ， 只 


z 


受 限 于 建 模 和 计算 能 力 的 可 应 用 于 实际 并 具有 发 
展 前 景 的 学 科 。 

今天 ， 模 拟 和 近似 解 越 来 越 多 地 促进 几乎 所 有 的 
感 兴趣 的 纳米 物理 学 应 用 。 在 理论 化 学 、 生 物 物 理 
学 、 凝 聚 态 物 理 、 半 导体 器 件 物理 等 大 量 的 文献 中 ， 
许多 核心 问题 已 被 〈 充 分 ， 或 者 较 充 分 ) 解决 。 实 
际 问题 是 找到 相关 工作 ， 并 不 断 地 转换 符号 和 单元 系 
统 应 用 结果 来 解决 手头 问题 。 


18.3 微米 -纳米 级 上 的 驱动 器 


纳米 机 器 人 和 纳米 机 器 人 机 械 手 的 定位 在 很 大 程 
度 上 取决 于 纳米 驱动 器 。 虽 然 纳米 级 驱动 器 尚 在 探索 
阶段 ， 基 于 MEMS 系统 的 执行 器 已 经 在 开始 减 小 驱 
动 器 的 尺寸 ”1 。 分辨 率 在 纳米 上 的 运动 已 经 得 到 
广泛 研究 ， 并 且 可 以 通过 各 种 驱动 原理 产生 这 些 运 
动 。 在 纳米 级 实现 驱动 普遍 采用 静电 、 电 磁 和 压 电 的 
方法 。 对 于 纳米 机 器 人 操作 ， 除 了 纳米 级 分 辩 率 和 较 
小 的 尺寸 ， 驱 动 涡 可 以 产生 较 大 的 冲程 和 较 强 的 力 以 
适应 此 应 用 。 只 要 驱动 器 的 速度 在 几 赫 效 以 上 ， 速 度 
标准 就 不 再 重要 。 表 18. 1 45 UBI fe! h gg 
于 微型 纳米 机 器 人 (从 参考 文献 [18.30] 部 分 适 
应 ) 应 用 的 驱动 器 数据 。 


表 18.1 微机 电 系统 上 的 驱动 器 


ul E N 功率 密度 
执行 器 类 型 | 运动 类 型 体积 /mm 速度 /s-1 H/N 冲程 /m | 分 辩 率 /mm pue » 参考 文献 
m 
静电 zh 400 5000 1x1077 6 x10 7? NA 200 [18.24 
磁性 线性 0.4 x0.4 x0.5 1000 2.6x1075 | 1x10-4 NA 3000 [18.25 
压 电 线性 25.4x12.7 x1.6 4000 350 1 x10-3 7x10-8 NA [18. 26 
NER ae E 、 " 功率 密度 
执行 器 类 型 | 运动 类 型 体积 /mm 速度 /s-! E/N + m)|) 冲程 /m | 分 辨 率 /m (W/m?) 参考 文献 
m 
静电 转动 71/4 x0. 5? x3 40 2x1077 2n NA 900 [18.27 
磁性 转动 2 x3.7 x0.5 150 1 x10 7 2n 5/367 3000 [18.28 
HERR 转动 T/4 x1.5? x0. 5 30 2x107" 0.7 NA NA [18.29 
关于 不 同 的 驱动 原理 的 几 篇 综述 文章 也 已 出 à 
18.3.1 静电 学 


HE 20 。 在 执行 器 设计 阶段 ， 必 须 考虑 在 这 个 范 
围 内 ， 对 如 运动 、 力 、 速 度 (驱动 频率 ) 、 功 耗 、 控 
制 精度 、 系 统 可 靠 性 、 鲁 棒 性 、 承 载 能 力 等 因素 进行 
权衡 。 本 节 回顾 了 在 纳米 级 上 的 基本 驱动 技术 及 其 洪 
在 的 应 用 。 


当 一 个 材料 逐渐 积累 或 者 失去 自由 电子 时 ， 就 会 
产生 静电 电荷 ， 这 还 可 以 产生 异种 电荷 相互 吸引 或 者 
同 种 电荷 相互 排斥 的 作用 力 。 由 于 静电 场 的 出 现 和 消 
失 都 非常 迅速 ， 因 此 这 些 设备 必须 有 同样 快 的 运行 速 
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度 并 且 受 环境 温度 变化 影响 很 小 。 

以 前 研究 进行 了 许多 微型 装备 的 实验 ， 使 用 静电 

FIA WW zl E fo GAS 9977. gon qp 007 m OK BS 

子 ”3。 这 种 类 型 的 驱动 在 实现 纳米 级 驱动 上 是 很 

重要 的 。 
静电 作用 力 可 以 产生 很 大 的 力 ， 但 是 跨越 距离 很 


压 电 材料 具有 和 较 高 的 力 和 速度 ， 在 不 通电 的 情况 
下 会 返回 到 一 个 中 间 位 置 。 它 们 表现 出 非常 小 的 冲程 
( 低 于 1% ) 。 交 变 电 流 在 压 电 材料 中 产生 的 振荡 和 样 
品 的 基本 共振 频率 的 操作 产生 最 大 的 伸 长 率 和 最 高 的 
电源 效率 !“” 。 压 电 驱 动 器 工作 在 粘 滑 模式 下 ， 可 
以 提供 毫米 到 厘米 的 冲程 。 大 多 数 商 用 的 纳米 机 械 手 


短 。 当 电场 必须 跨越 很 大 的 距离 时 ， 就 需要 提供 更 高 
的 电压 ， 从 而 来 维持 所 需要 的 力 。 静 电 设 备 极 低 的 电 
流 消耗 ， 使 得 驱动 更 加 高 效 。 


18.3.2 电磁 学 


采用 此 类 型 的 驱动 器 ， 如 New Focus 的 PicmotorsTM 
和 Klock 的 NanomotorsTM。 


18.3.4 其 他 技术 
其 他 技术 如 热力 学 、 相 变 、 形 状 记 忆 、 磁 致 伸 


当 电 流通 过 导电 材料 时 将 会 产生 电磁 。 相 邻 的 导 
体 产生 的 吸引 力 或 排斥 力 ， 其 大 小 与 电流 强 弱 成 正 
比 。 可 以 构造 收集 和 集中 电磁 力 的 结构 ， 并 且 利 用 这 
些 力 产生 运动 。 
由 于 磁场 的 出 现 和 消失 非常 迅速 ， 因 此 设备 的 操 
作 速 度 也 要 求 非常 快 。 由 于 电磁 场 可 以 存在 于 较 大 的 
温度 范围 内 ， 因 此 其 性 能 主要 由 建造 执行 器 的 材料 特 
性 所 限制 。 

一 个 微型 电磁 制动器 的 例子 是 使 用 一 个 小 的 电 
RAER PE A Be TE E M RR AA O E R EUS 。 
动 需 向 下 进入 微型 和 纳米 领域 的 可 扩展 性 可 能 会 受 


EUN 电流 变 、 电流 体 动力 学 、 抗 磁 性 、 磁 流 体 、 造型 
改变 、 聚 合 物 和 生物 方法 等 CAA, DLA Ae 
等 ) ， 在 表 18. 2 中 对 这 些 方法 进行 了 比较 。 


表 18.2 几 种 纳 驱动 器 的 比较 


到 制造 小 型 电磁 线圈 难度 的 限制 。 
磁 装 置 要 求 电流 导体 和 移动 元 素 是 相互 垂直 的 ， 这 


对 于 通常 用 来 制造 硅 器 件 设备 的 平面 制作 技术 是 很 
难 的 。 

电磁 装置 的 一 个 重要 的 优势 是 将 电能 
运动 的 高 效 性 。 从 电源 的 角度 这 个 转换 电流 消耗 
较 少 。 


18. 3.3” 压 电学 

当 电 场 或 者 电荷 变化 时 ， 某 些 晶 体 的 尺寸 就 会 发 
生变 化 ， 而 压 电 运动 就 来 自 于 这 种 尺寸 的 变化 。 结 构 
构造 用 于 收集 和 集中 当 尺 十 变化 时 产生 的 力 ， 并 且 利 
用 这 些 力 产生 运动 。 典 型 的 压 电 材 料 包括 石英 、 钳 钛 
Bir, RHE A AS A BER A, WR On) E 
(PVDF), 

压 电 材料 在 电压 的 变化 下 反应 非常 迅速 ， 并 且 具 
有 可 重复 性 。 利 用 可 重复 的 振荡 可 以 产生 精确 运动 ， 
例如 在 很 多 电子 设备 上 使 用 石英 计时 晶体 。 压 电 材 料 
也 可 以 被 用 于 制造 传感器 ， 将 拉 伸 和 压缩 力 转 换 为 
电压 。 

FEMUR BE, EEE E Bi Pe PERE a oH AZ 
RE") STMs 和 大 多 数 纳米 机 械 手 利用 的 
就 是 压 电 驱动 器 。 


T 效率 速度 | 功率 密度 
静电 很 高 " 低 
B, fo B p 高 
压 电 很 高 快 " 
电磁 驱 
热机 制 很 高 e " 
此 外 ， 大 多 数 电 相 变 很 高 " = 
形状 记忆 低 中 非常 高 
梯 发 电机 " ü p 
变 流 电 中 中 
转换 成 机 械 变 流 电 
电流 体 动力 学 m xs m 
反 磁 力学 " m m 


18.4 微米 -纳米 级 上 的 传感器 


一 篇 简要 的 综述 文章 给 出 了 微 纳 米 机 器 人 研究 领 
域 中 常用 的 成 像 工具 ， 其 中 包括 光学 、 电 子 和 扫描 探 
针 显 微 镜 。 以 下 的 章节 将 会 讨论 这 些 工 具 的 应 用 和 
集成 。 

EM- 纳米 级 上 选择 合适 的 工具 进 
时 ， 应 首先 考虑 以 下 因素 : 

1) 样本 。 大 小 、 导 电 性 、 与 环境 相 容 性 是 其 中 
最 需要 考虑 的 方面 。 例 如 在 生物 应 用 中 ， 通 常 需 
气 或 者 液体 ， 因 此 分 辩 率 低 的 光 镜 是 首要 选择 。 如 果 
需要 用 到 高 分 辨 率 ， 则 可 以 选用 原子 力 显微镜 或 扫描 
近 场 光学 显微镜 。 

2) 分 辩 率 。 


行 成 像 /检测 


能 够 看 到 样本 的 精细 程度 。 一 
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够 看 到 细微 的 部 分 ， 就 可 以 将 它们 放大 。 每 个 显微镜 
都 有 有 限 的 分 辨 率 ， 如 果 想 超过 最 大 的 分 辩 率 将 会 得 
到 空 的 放大 倍率 。 一 般 来 说 ， 光 学 显微镜 不 会 超过 
200nm 的 分 状 率 。 最 好 的 商业 扫描 电子 显微镜 


(SEM) 具有 大 约 1nm 的 分 辨 率 ， 而 透射 电子 显微镜 
(TEM) 则 能 达到 0. 2nm 的 分 辩 率 ， 低 温 下 的 超 高 真 
空 扫描 隧道 显微镜 (STM) 可 以 用 于 观察 原子 结构 。 
表 18. 3 中 进行 了 光学 显微镜 和 电子 显微镜 的 比较 。 


表 18.3 光学 显微镜 和 电子 显微镜 的 比较 


特 人 性 OM TEM SEM 
Y ~ 或 者 是 在 

一 般 用 途 表面 变形 和 切片 (1 ~40pm) “2 me 表面 变形 

照明 源 可 见 光 高 速度 电子 云 高 速度 电子 云 
最 高 分 辩 率 ca. 0. 2nm ca. 0. 2nm ca. 3 ~6nm 
放大 倍率 范围 10 ~ 1000X 500 ~ 500 000X 20 ~ 150 000X 

深度 0. 002 ~0. 05nm (N. A.1. 5) 0. 004 ~0. 006mm (N. A. 10 7) 0. 003 ~ 1mm 
镜头 类 型 玻璃 电磁 电磁 

图 像 射线 点 镜头 上 的 眼 镜头 磷 光 片 扫描 设备 阴极 管 


3) 深度 。 在 可 接受 焦距 内 的 标本 的 深度 范围 。 
显微镜 的 深度 很 小 ， 这 要 求 不 断 地 向 上 向 下 来 调整 查 
看 厚 的 样本 。 

4) 对 比 度 。 亮 与 白 之 间 的 比例 。 大 多 数 情况 
下 ， 显 微 镜 使 用 吸收 对 比 度 ， 也 就 是 说 ， 为 了 观察 ， 
样本 通常 是 被 浸染 的 。 这 被 称 为 明 视 野 显微镜 
( 术 )。 还 有 使 用 外 加 的 方式 产生 对 比 的 其 他 类 型 显 
微 镜 ， 如 相 衬 、 暗 场 、 微 分 干涉 对 比 。 

5) 明亮 度 。 光 的 数量 。 显 微 镜 放 的 倍数 越 大 就 
需要 越 多 的 光线 。 光 源 也 应 有 一 个 波长 (颜色 ) 的 
长 度 ， 这 将 促进 与 样本 相互 作用 。 根 据 样本 是 如 何 照 
亮 的 ， 所 有 的 显微镜 可 以 分 为 两 种 类 型 。 典 型 的 复式 
显微镜 的 光线 穿 过 标本 和 形成 光学 图 像 而 被 收集 ， 称 
为 透射 照明 。 立 体 显微镜 通常 是 利用 反射 投影 照射 ， 
用 于 不 透明 的 标本 。 光 被 反射 到 标本 上 ， 然 后 进入 
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化 时 代 ， 它 们 使 用 电荷 耦合 器 件 (CCD) 和 数码 相 
机 捕获 图 像 。 

现代 显微镜 的 发 展 ， 使 光学 显微镜 成 为 了 一 个 大 
家 族 。 为 了 特殊 用 途 ， 也 可 以 选择 其 他 类 型 的 光学 显 
微 镜 。 这 包括 相 衬 显微镜 、 交 光 显 微 镜 、 共 焦 扫描 光 
学 显微镜 和 用 于 图 像 重 建 的 去 卷 积 显微镜 。 


18.4.2 ”电子 显微镜 


1. 扫描 电子 显微镜 (SEM) 

从 1966 年 SEM 成 为 商用 以 来 ，SEM 在 高 分 辩 率 
和 深度 上 都 比 传统 的 光学 显微镜 更 有 价值 。 传 统 的 
SEMs 可 以 观测 到 纳米 级 别 ( o 1nm), ， 而 光学 显微镜 
只 能 达到 200nm S, 不同 于 传统 的 光学 显微镜 ， 
SEMs 拥有 更 好 的 深度 信息 这 样 可 以 为 三 维 外 观 提供 
图 像样 本 。 早 期 的 SEMs 仅 限于 观测 导电 样本 。 然 


ju 


物镜 。 


18.4.1 光学 显微镜 

光学 显微镜 自从 16 世纪 后 期 发 明 以 来 ， 在 基础 
生物 学 、 生 物 医学 研究 、 医 疗 诊断 和 材料 科学 等 方面 
扩充 了 我 们 的 知识 。 光 学 显微镜 可 以 将 物体 放大 
1000 倍 以 上 ， 给 我 们 展现 了 一 个 微观 世界 。 光 显 微 
镜 技 术 的 发 展 远 远 超出 罗伯特 胡 克 和 安东尼 列 文 虎 克 
的 第 一 个 显微镜 。 而 专业 技术 和 光学 的 发 展 揭示 了 活 
细胞 生物 化 学 结构 。 目 前 使 用 的 大 部 分 光学 显微镜 被 
称 为 复合 显微镜 ， 物 体 放 大 图 像 是 由 物镜 和 第 二 个 成 
BAS 〈 眼 或 目镜 ) 形成 的 。 显 微 镜 也 进入 了 数字 


而 ， 许 多 现在 的 SEMs 利用 变 压 室 不 仅 可 以 观测 导电 
样本 还 可 以 为 非 导 体 拍 摄 图 像 。 

2. 透射 电子 显微镜 (TEM) 

透射 电子 显微镜 可 以 精确 至 一 个 原子 尺度 以 下 大 
约 1A (也 就 是 0.1nm)。TEM 操作 模式 和 SEM 相似， 
两 个 显微镜 包含 一 个 电子 枪 照明 源 。 然 而 ，TEM (3€ 
射电 子 显微镜 ) 检测 穿 过 给 定 样本 的 电子 。 因 此 ， 
它 的 电子 枪 工作 在 较 高 能 量 水 平 之 间 50 ~ 1000kV， 
而 SEM 的 电子 枪 电压 一 般 为 1-30kV。 为 了 正确 的 成 
像 ， 样 本 必须 很 薄 ， 这 样 电子 束 才 可 以 穿 透 样本 。 透 
不 过 样本 的 电子 将 检测 不 到 。 不 像 SEM，TEM 产生 
图 像 在 外 观 上 是 二 维 的 。 
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18.4.3 扫描 探 针 显微镜 


1. 扫描 探 针 显微镜 (STM) 

和 TEM 相似 ，STM 同样 是 在 原子 级 别 上 观测 样 
本 。STM 的 扫描 探 针 是 由 贵金属 前 成 原子 大 小 的 尖 
头 ， 安 装 在 压 电 驱 动 (x, y, z) 的 线性 阶段 。STM 
使 用 被 称 为 隧道 的 量子 力学 效应 。 当 一 个 很 小 的 电 
位 差 驱 动 电子 时 ， 电 子 穿 过 探 针尖 和 样本 之 间 的 间 
险 ， 从 而 产生 电子 隧道 效应 。 此 事 发 生 在 探 针 尖 和 
样本 Ángstróm- scale 距离 之 间 。 隧 道 电 流 ， 通 常 都 
是 几 毫 微 安 ， 和 探 和 针尖 与 样本 之 间 表 面 间距 直接 有 
关 。 因 而 隧道 电流 是 可 以 测 到 的 ， 并且 利用 反馈 控 
制 系统 通过 控制 探 针 尖 和 样本 之 间 的 距离 可 以 使 得 
电流 保持 在 一 个 恒定 值 。 然 后 探测 器 尖端 沿 着 样品 
整个 表面 进行 扫描 (*，y) 。 由 于 控制 系统 能 同时 
保持 恒定 的 隧道 电流 ， 从 而 保持 恒定 的 探 针尖 和 样 
品 之 间 的 距离 (z) ， 扫 描 的 结果 z(x，y) 产生 一 个 
样本 图 形 ， 该 图 形 有 足够 的 分 辨 率 来 检测 原子 级 别 
上 的 特征 。STM 通过 操作 所 谓 的 恒 高 模式 可 以 快速 
成 像 ， 探 针 针 尖 在 平行 于 平均 表面 部 分 的 平面 扫描 。 
探 针 尖 - 样 本 距离 (2) 可 以 直接 从 隧道 电流 推断 
出 来 .41 。 

2. 原子 力 显 微 镜 (AFM) 

AFM 原子 力 显 微 镜 被 认为 是 STM 显微镜 的 衍生 
io STM 的 一 个 缺点 是 它 要 求 导 电 探 针 针 尖 和 样本 
必须 正常 工作 。 研 制 AFM 是 用 来 观测 非 导电 样本 ， 
这 使 得 它 与 STM 相 比 更 具 广 泛 应 用 。 除 了 可 以 为 非 
导电 样本 成 像 ，AFM 还 可 以 为 浸入 液体 的 样本 成 
像 ， 而 这 对 生物 应 用 非常 有 用 。 虽 然 STM 和 AFM 
是 相似 的 ， 都 是 利用 原子 大 小 的 探 针 扫描 样本 的 表 
面 ， 然 而 它们 利用 的 原理 是 不 同 的 。 原 子 力 显 微 镜 
(AFM) 是 基于 原子 的 力量 ， 而 STM 利用 的 是 电子 隧 
i, AFM 的 探 针 针尖 装 在 微 悬 臂 梁 的 末端 。 在 很 短 
的 分 离间 隙 中， 在 探 针 针尖 原子 与 样本 的 原子 之 间 的 
作用 力 引 起 微 悬 人 臂 粱 偏转 。 这 偏转 通常 是 可 以 通过 用 
激光 照射 在 微 悬 臂 深 的 背面 测量 出 来 。 激 光 反 射 聚焦 
到 光 探 测 嚣 上， 从 而 使 得 微 甚 辟 梁 恢复 偏转 。 应 用 胡 
克 定 律 可 以 计算 力 ， 它 只 与 材料 的 刚度 和 挠 度 有 关 ， 


水 膜 ， 从 而 出 现 了 毛细 力 带 来 的 问题 。 而 这 些 都 只 能 
在 真空 环境 下 或 溶液 中 解决 。 


18.5 制造 


微米 - 纳米 机 器 人 设备 的 设计 和 现 有 的 制作 技术 
有 着 千 丝 万 缕 的 联系 。 虽 然 在 过 去 几 十 年 微 加 工 的 技 
术 得 到 了 稳定 的 发 展 ， 但 是 纳米 加 工 制作 还 需要 深入 
的 发 展 ， 并 且 这 些 过 程 产生 的 设计 限制 还 没有 突破 。 
本 节 将 着 重 介绍 包括 光 刻 ， 薄 膜 沉积 ， 化 学 蚀刻 ， 电 
镀 在 内 传统 的 微 加 工 过 程 ， 并 描述 一 些 新 兴 的 纳米 加 
工 技术 。 

大 多 数 微型 和 纳米 加 工 技术 都 是 来 源 于 半导体 工 
业 的 标准 制造 方法 只“ 1 。 因 此 ， 清 楚 地 了 解 这 些 
技术 对 于 任何 从 事 微 /纳米 领域 研究 和 发 展 的 轨迹 的 
人 都 是 必需 的 。 


18.5.1 微 制造 


本 节 主 要 讨论 在 常用 的 微 结构 制造 中 主要 微 制造 
技术 。 

1. 影印 石 版 术 

光 刻 就 是 将 电脑 上 的 图 像 转 换 到 底层 上 ( 硅 
片 ， 玻 璃 等 ) 。 这 种 技术 后 来 被 用 于 制作 薄膜 ( 
化 物 ， 氮 化 物 等 ) 。 尽 管 使 用 一 束 紫 外 线 光 源 的 影 
印 石 版 术 ， 也 就 是 所 谓 的 光 刻 ， 但 是 ， 作 为 其 替代 
方法 的 电子 束 和 X 射线 平版 印刷 在 MEMS 和 纳米 制 
造 领域 已 引起 相当 大 的 关注 。 在 本 章 我 们 将 会 讨论 
光 刻 ， 下 面 的 章节 进行 关于 纳米 制造 电子 束 和 X 射 
线 的 讨论 。 

对 一 个 特定 制造 序列 过 程 遵循 计算 机 布局 创造 的 
开始 点 是 遮光 膜 的 生成 。 这 就 牵涉 到 摄影 过 程序 列 
(使 用 光学 或 电子 束 型 发 生 器 ) ， 结 果 在 薄 玻 璃 板 
(=100nm) 的 铬 层 形成 所 期 望 的 图 像 。 生 成 遮光 膜 
之 后 ， 就 可 以 进行 光 刻 和 蚀刻 工艺 ， 如 图 18. 2 所 示 。 
在 基板 上 堆积 好 需要 的 材料 之 后 ， 用 光 致 抗 蚀 剂 旋 
涂 基 板 的 光 刻 过 程 就 开始 了 。 这 是 一 种 聚合 物 感光 
材料 ， 可 以 被 压 成 液体 形式 的 干 胶片 ， 另 外 还 通常 
添加 一 种 附着 力促 进 剂 如 六 甲 基 二 硅 氮 烷 ， 用 于 前 


T 


力 可 以 精确 至 微微 牛顿 (107 N) 。 原 子 力 显微镜 有 
三 种 主要 操作 模式 : 接触 模式 、 非 接触 模式 和 轻 敲 打 
模式 。 

与 SEM 和 TEM 不 同 ，STM 和 AFM 不 需要 工作 
在 真空 环境 中 。 然 而 ， 高 真空 是 有 利 的 ， 可 以 防止 样 
本 被 周围 环境 以 及 湿度 污染 。 此 外 ， 由 于 湿度 原因 利 
用 AFM 操作 原子 分 辩 率 几乎 是 不 可 能 的 。 湿 度 产 生 
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确定 最 终 的 抗 蚀 厚度 ， 此 厚度 一 般 为 0.5 ~ 2. 5pm, 
两 个 不 同 种 类 的 光 致 抗 蚀 剂 : 正 性 的 和 负 性 的 。 利 
用 正 性 抗 蚀 剂 ， 在 此 后 的 制作 阶段 紫外 线 曝 光 区 域 
将 会 发 生 降解 反应 ， 而 用 负 性 抗 蚀 剂 时 ， 在 制作 之 
后 曝光 区 域 仍 然 保 持 完 整 无 损 。 用 光 致 抗 蚀 剂 旋 涂 
胶 之 后 ， 就 需要 对 基板 进行 软 烘 干 ， 软 烘 干 过 程 可 
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以 使 溶剂 从 光 刻 胶 中 挥发 出 来 ， 并 且 可 以 提高 光 刻 
胶 的 附着 力 。 随 后 ， 遮 光 膜 和 品 圆 对 齐 ， 光 致 抗 蚀 
剂 暴露 在 紫外 线 下 。 


细小 沉积 物 膜 (氧化 物 、 兴 奋 剂 、CVD、PVD、 
光 致 抗 蚀 剂 等 ) 


自 旋光 致 抗 蚀 剂 


硬 烤 


等 离子 蚀刻 QE (各 向 异性 和 各 向 同性 ) 
或 干燥 (高压 ， 刻 蚀 ， 离 子 铣 ) ) 


图 18.2 典型 的 微细 加 工 的 工艺 流程 


在 曝光 之 后 ， 光 致 抗 蚀 剂 的 曝光 类 似 于 照片 底片 
的 上 曝光。 为 了 增强 光 刻 胶 对 唱 圆 表面 的 附着 力 ， 需 要 
对 抗 刨 剂 进行 硬 烘 干 (20 ~ 30min 在 120 ~ 180°), 
在 品 圆 上 创建 所 需要 的 图 像 来 结束 硬 烤 步 又。 接 下 
来 ， 蚀 刻 底 层 薄 膜 ， 利 用 丙酮 或 其 他 有 机 溶剂 的 去 除 


光 致 抗 蚀 剂 。 图 18. 3 展示 了 一 个 正 性 的 光 致 抗 蚀 剂 
光 刻 步骤 的 原理 图 。 
光 致 抗 蚀 剂 
| So | So — OE 
Si Si 
a) b) 


M 
1H II ILLTII 


—— ——— 
光 掩 膜 
| So | [| So | 
) ) 


c d 
| SiO) | | Sio | 
e) f) 
图 18.3 具有 正 性 光 致 抗 蚀 剂 光 刻 步骤 示意 图 
a) 氧化 底版 b) 旋转 光 致 抗 蚀 剂 和 软 烤 


c) 曝光 处 理光 致 抗 蚀 剂 d) 硬 烤 光 致 抗 蚀 剂 
e) 蚀刻 氧化 物 f£) 条 纹 化 光 致 抗 蚀 剂 


2. 薄膜 淀 积 处 理 和 加 添加 剂 

薄膜 沉积 处 理 和 加 添加 剂 被 广泛 应 用 于 微型 和 纳 
米 加 工 技术 。 大 部 分 制造 结构 包含 材料 而 不 是 基板 ， 
这 些 材料 可 以 通过 各 种 沉积 技术 或 修改 板 获取 到 。 这 
些 技术 包括 氧化 、 摊 杂 、 化 学 气相 淀 积 (CVD), W 
理气 相 沉 积 (PVD) 和 电镀 。 

3. 蚀刻 和 基质 去 除 

微型 和 纳米 加 工 中 ， 除 了 薄膜 蚀刻 、 通 常 基板 
(RE, WIS, MEISE) 需要 拆除 ， 以 创造 各 种 机 械 
结构 ( 梁 ， 板 等 )。 任 何 蚀 刻 过 程 包括 两 个 重要 的 指 
标 是 选择 性 和 方向 性 。 
选择 性 是 腐蚀 剂 可 以 区 分 掩 膜 层 和 需要 蚀刻 层 的 
程度 。 方 向 性 必须 和 掩 膜 下 的 蚀刻 轮廓 一 致 。 在 同 向 
蚀刻 中 ， 腐 蚀 剂 以 同样 的 速度 在 材料 的 各 个 方向 进行 
反应 ,在 掩 膜 下 产生 半圆 形 的 轮廓 ( 见 图 18.4)。 在 
异 向 蚀刻 中 ,溶解 速度 取决 于 具体 的 方向 ， 可 以 得 到 
直 侧 壁 或 其 他 非 圆 剖面 ( 见 图 18.4b)。 可 以 将 各 种 
蚀刻 技术 分 成 干 式 蚀 刻 和 湿式 蚀刻 两 大 类 。 由 于 边缘 
腐蚀 ， 湿 法 刻 蚀 局 限于 3 微米 以 上 的 图 案 尺 寸 。 光 致 
抗 蚀 剂 和 氮 化 硅 是 两 种 最 常见 的 湿 氧 化 层 蚀刻 屏蔽 材 
料 。 各 异 向 性 和 各 同 向 性 的 湿 法 刻 蚀 的 晶体 〈 硅 和 
HHL) 和 非 唱 体 (玻璃 ) 基板 在 微米 和 纳米 制造 
中 都 是 重要 的 材料 31。 


lim 


TEIR 
rng Jong 


a) b) 
图 18.4” 透 过 光 致 抗 蚀 剂 掩 模 形 成 的 各 项 同 向 蚀刻 侧面 
a) 和 各 项 异 向 蚀刻 侧 F 

b) 通过 光 致 抗 蚀 剂 拖 膜 刻 蚀 

这 些 异 向 性 行为 腐蚀 剂 已 被 广泛 用 于 制作 粱 、 膜 
和 其 他 机 械 和 结构 的 组 件 。 图 18. 5 显示 了 典型 的 用 一 
个 各 向 异性 湿式 蚀刻 剂 蚀 刻 的 (100) 硅 干 胶片 的 横 
截面 。 如 我 们 所 见 ，111 被 曝光 了 ， 并 且 生 成 54.7° 倾 
斜 侧 壁 。 根 据 掩 膜 开放 的 程度 ， 形 成 一 个 V 形 权 或 梯 
形 沟 槽 (100) 干 胶片 。 比 较 大 的 开放 程度 会 使 得 硅 
在 各 个 方向 上 都 被 蚀刻 ， 从 而 创造 另 一 面 的 一 个 薄 介 
质 膜 。 应 该 提 到 的 是 凸 的 比 四 的 蚀刻 速度 要 快 ， 这 样 

可 以 制作 不 导电 的 (例如 ， 毛 化 物 ) EXP. 

(100) SiO; 


图 18.5 (100) 硅 片 的 各 向 异性 刻 蚀 剖面 
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于 蚀 刻 技术 一 般 都 是 基于 等 离子 体 的。 与 湿 蚀 刻 
技术 相 比 它们 有 以 下 几 个 优点 : 较 小 的 切削 部 分 
(适用 更 小 尺寸 的 图 案 ) ， 更 高 的 异 向 性 (人 允许 垂直 
结构 的 高 宽 比 ) 。 然 而 ， 干 式 刻 蚀 技术 的 选择 性 低 于 
湿 法 刻 蚀 技术 ， 并 且 必 须 考虑 到 掩 膜 材 料 的 有 限 蚀刻 
速率 。 三 个 基本 的 干 法 刻 蚀 技术 ， 即 高 压 等 离子 体 刻 
人 蚀 ， 反 应 离子 刻 蚀 (RIE) ， 离 子 束 刻 蚀 ， 利 用 不 同 
的 机 制 来 获取 方向 性 。 


纳米 制造 


NEMS 设计 与 装配 是 一 个 新 兴 的 领域 ， 吸 引 了 越 
来 越 多 的 研究 者 。 纳 米 制造 的 两 种 方法 即 自 顶 向 下 和 
自 底 向 上 的 方法 ， 这 两 种 方法 已 经 被 纳米 技术 研究 人 
员 认 可 ， 现 在 被 不 同 领域 的 研究 者 研究 使 用 。 自 项 向 
下 的 方法 是 基于 精密 加 工 ， 例 如 纳米 蚀刻 、 纳 米 印 
刷 、 化 学 腐蚀 这 样 的 技术 。 现 在 ， 这 些 都 是 二 维 制造 
工艺 ， 具 有 相对 较 低 分 辩 率 。 自 底 向 上 策略 是 基于 装 


18. 5.2 


用 来 制作 各 种 纳米 结构 。 

一 种 有 趣 的 新 技术 就 是 纳米 压 印 加 工 技术 ， 这 
种 技术 避免 电子 束 光 刻 串 行 和 生产 能 力 低 的 限制 来 
制造 纳米 技术 。 参 考 文献 [18.54] 这 项 技术 使 用 
电子 束 焊 接 的 硬 质 材 料 来 控制 (或 塑造 ) 标记 ， 并 
使 聚合 的 抗 蚀 剂 产 生 畸 变 。 通 常 在 反应 离子 蚀刻 之 
后 将 标记 模板 转移 到 基质 上 。 该 技术 在 经 济 上 是 有 
优势 的 ， 因 为 一 个 图 印 都 可 以 反复 使 用 制造 大 量 的 
纳米 结构 。 

2. 取向 附 生 及 应 变 工程 

原子 精度 沉积 技术 ， 如 分 子 束 取向 附 生 (MBE) 
和 有 机 金属 化 学 气相 沉积 (MOCVD) 技术 ， 用 于 制 
造 大 量 量子 限制 结构 和 设备 (量子 阱 激光 器 ， 光 电 
探测 器 ， 共 振 遂 穿 二 极 管 器 件 等 ) ， 已 被 证 明 是 有 效 
HERAN 

3. BK SAI HEA 

在 世 水 笔 刻 蚀 技术 (DPN) "P, AFM 探 针 针尖 在 


配 技 术 的 。 目 前 ， 这 些 策 略 包 括 如 自 组 装 ， 芯 笔 光 刻 
和 指导 性 自我 组 装 等 技术 。 这 些 技 术 能 大 规模 产生 纳 
米 模板 。 

在 本 节 中 ， 我 们 将 讨论 三 种 主要 的 纳米 制造 技 
术 。 这 些 包 括 : 

1) 电子 束 光 刻 和 纳米 压 印 加 工 。 

2) 外 延 和 应 变 设 计 。 

3) 杖 笔 纳米 光 刻 技术 。 

1. 电子 束 光 刻 和 纳米 压 印 加 工 

在 前 面 章 节 中 ， 我 们 讨论 了 若干 种 重要 的 普遍 应 
用 于 MEMS 和 微 制造 的 电子 东 光 刻 技术 ,包括 各 种 
形式 的 紫外 线 (固定 、 深 、 极 限 ) 和 X 射线 电子 束 
光 刻 。 然 而 ， 由 于 缺乏 分 辩 率 (在 使 用 紫外 线 这 种 
情况 下 )， 或 者 难以 制造 遮 日 和 热 幅 光源 (如 X 射 
线 ) ， 这 些 技术 不 适合 于 纳米 级 别 的 制造 。 对 于 制作 
纳米 结构 ， 电 子 束 光 刻 技 术 是 一 个 有 了 吸引 力 的 可 选 的 
技术 ”I， 它 使 用 电子 束 使 电子 敏感 的 抗 刨 剂 曝光 ， 
如 聚 甲 基 丙烯 酸 甲 酯 (PMMA) 溶解 在 毛茶 (IE) 
或 氧 甲 基 聚 茶 乙 烯 树脂 〈 负 ) 中 。 

虽然 电子 枪 在 TEM (透射 电子 显微镜 ) 中 经 常 
被 使 用 ， 但 它 通 常 是 SEM (扫描 电子 显微镜 ) 的 组 
成 部 分 。 虽 然 类 似 于 1A 这 样 的 波长 很 容易 实现 ， 但 
是 电子 散射 只 能 抵抗 在 10nm 以 上 的 范围 内 。 光 束 控 
制 和 模式 生成 是 通过 计算 机 接口 实现 的 。 
电子 束 光 刻 串 行 生产 ， 因 此 其 生产 能 力 很 低 。 尽 
管用 在 基本 微 物理 的 制造 设备 上 这 不 是 主要 关注 的 ， 
但 是 它 严 重地 限制 了 大 规模 的 纳米 制造 。 电 子 束 微 
影 ， 连 同 诸如 发 射 、 蚀 刻 、 电 沉积 这 样 的 过 程 ， 可 以 


大 气 环境 中 节 有 想 要 的 化 学 药品 ， 并 且 拿 到 接触 表面 。 
墨水 分 子 像 钢 笔 一 样 从 尖端 流 到 表面 上 。 已 证 实 使 用 
这 种 技术 具有 空间 分 辨 率 Snm 的 线 的 宽度 可 以 降 至 
12nmU* 59 o EH DPN 的 图 案 的 种 类 主要 有 导电 聚合 
物 、 金 属 、 树 形 高 分 子 、 脱 氧 核糖 核酸 (DNA), A 
机 染料 、 抗 体 和 硫 醇 。 


18.6 微 装配 


为 了 减少 制造 过 程 的 成 本 、 降 低 复杂 度 ， 装 配 通 
党 是 大 型 产品 生产 商 必 备 的。 装配 通过 使 用 相对 简单 
的 部 分 组 建 复杂 产品 ， 集 成 不 相 容 的 机 械 加 工 过 程 。 
并 使 得 大 型 产品 的 维护 与 更 新 成 为 可 能 。 在 现代 设计 
和 制造 技术 追求 小 型 化 、 集 成 化 ， 特 别 是 在 集成 电路 
以 及 微机 电 系 统制 造 技术 的 推动 下 ， 装 配 技术 开始 向 
微型 化 方向 发 展 。 随 着 制造 技术 向 微观 甚至 纳米 领域 
的 发 展 ， 词 语 微型 装配 被 创建 来 指 代 微观 、 中 尺度 制 
造 中 应 用 的 装配 。 微 型 装配 的 正式 定义 为 : 微型 装配 
是 一 种 具有 微观 容 差 的 微观 尺度 或 者 中 尺度 特点 的 物 
体 的 装配 。 


18. 6.1 


自动 微 装配 系统 


在 各 种 各 样 的 MEMS (微机 电 系 统 ) 的 制造 过 程 
中 ， 微 装配 起 着 举足轻重 的 作用 ,包括 设备 的 制造 、 
封装 及 互 连 。 微 机 电 系统 设备 的 制造 和 大 规模 集成 电 
路 的 制造 有 着 根本 上 的 不 同 ， 通 常 需要 复杂 的 3-D 
模型 来 建 模 。 然 而 ， 几 乎 当前 所 有 MEMS (微机 电 系 
统 ) 制造 技术 都 受到 有 限 的 可 用 材料 、 有 限 的 现实 


18S ”微型 和 纳米 机 器 人 335 


3- D 制造 技术 以 及 制造 过 程 中 兼容 性 的 限制 。 微 装配 
技术 为 解决 这 种 限制 提供 了 一 种 可 能 的 解决 方案 。 比 
如 : 不 相 容 的 制造 过 程 可 以 通过 微 装配 的 方式 集成 起 
来 。 它 使 得 利用 非 传统 的 制造 技术 ， 比 如 激光 切割 技 
术 、 微 线 电 火花 加 工 技术 以 及 微观 打 麻 技术， 不 一 定 
使 用 半导体 材料 的 制造 技术 成 为 可 能 。 复 杂 的 3-D 
建 模 技术 舍弃 相对 简单 的 几何 学 也 可 以 用 来 制造 。 微 
装配 对 于 MEMS (微机 电 系 统 ) 的 组 装 和 互 连 同样 是 
非常 重要 的 。 

从 机 器 人 系统 和 自动 化 的 观点 来 看 ，MEMS 设 
备 制 造 和 组 装 共 享 了 很 多 公共 的 装配 要 求 。 这 两 个 
处 理 过 程 的 一 个 基本 的 共性 是 都 要 求 能 够 操纵 微型 / 
中 型 对 象 ， 这 样 就 可 以 建立 精确 的 空间 关系 ， 也 可 
以 执行 相应 的 物理 /化 学 操作 。 男 一 个 共同 的 需求 是 
控制 相互 作用 力 。MEMS 设备 经 常 包含 一 些 易 损坏 
的 结构 ， 比 如 细 的 支撑 梁 或 薄膜 ， 这 就 需要 在 操作 
中 控制 相互 作用 力 。 典 型 的 力 大 小 在 微 牛顿 到 毫 牛 
顿 之 间 。 

MEMS 设备 通常 是 三 维 的 。MEMS 组 装 不 仅 需 要 
电路 上 的 相互 连接 来 传递 信号 ， 还 需要 机 械 上 的 相互 
连接 来 同 它们 的 外 部 环境 相互 作用 。 很 多 这 种 机 械 上 
的 交互 需要 三 维 空间 上 的 巧妙 控制 和 三 维 的 力度 控 
制 。 实 际 的 操作 是 严格 特定 于 应 用 程序 的 ， 这 对 自动 
微 装 配 系统 的 发 展 造成 极 大 的 挑战 。 自 动 IC 封装 系 
统 可 用 于 包装 某 种 MEMS 设备 ， 如 加 速度 计 和 陀螺 
仪 。 然 而 ， 微 流体 装置 ， 光 学 MEMS 器 件 ， 和 混合 
微 系 统 的 包装 往往 需要 新 的 自动 微 装配 技术 和 系统 的 
发 展 。 

选择 装配 模式 是 开发 自动 微 装配 系统 的 首要 决 
定 。 一 系列 的 微型 组 件 需要 使 用 微型 操纵 器 和 感知 反 
馈 。 在 每 一 个 时 刻 ， 只 有 一 个 或 几 个 部 分 处 于 组 装 状 
态 。 根 据 所 使 用 的 物理 效应 ， 可 以 确定 或 猜测 并 行 的 
微 组 装 。 芯 片 键 合 是 一 个 确定 性 的 并 行 微 组 装 例子 。 
在 随机 并 行 微 组 装 中 ， 在 大 量 的 零 部 件 组 装 的 同时 使 
用 分 布 式 的 物理 效应 ， 如 静电 力 、 毛 细 管 力 、 离 心力 
或 振动 。 事 实 上 ， 随 机 并 行 的 基本 理念 是 尽量 地 减少 
感官 反馈 的 使 用 。 

这 些 组 装 模 式 各 有 利 整 。 每 个 都 有 适合 它们 自己 
的 应 用 程序 。 确 定性 的 并 行 装 配 和 顺序 的 微 装 配 有 若 
于 共性 ， 比 如 : 通常 在 确定 性 的 并 行 微 组 装 中 使 用 感 
官 反 馈 。 然 而 ， 确 定性 的 并 行 微 组 装 各 部 分 之 间 的 相 
对 定位 精度 要 求 高 。 此 外 ,为 了 能 够 并 行 操作 ， 只 能 
组 装 简单 的 平面 结构 。 

由 于 MEMS 封装 的 三 维 操纵 和 微 装配 的 要 求 ， 
可 以 预计 ， 自 动 顺序 微 装配 将 是 以 后 最 广泛 采用 的 


解决 方案 。 尤 其 是 需要 多 自由 度 的 相互 作用 力 的 控 
制 的 MEMS 应 用 封装 应 使 用 顺序 微 装 配 。 顺 序 微 装 
配 的 主要 的 可 能 的 缺点 是 其 低 吞 吐 量 。 这 个 缺点 往 
往 可 以 通过 适当 的 系统 设计 加 以 克服 。 在 这 里 ， 我 
们 引入 一 个 立体 的 工业 应 用 的 微 装 配 例子 。 在 引线 
键 合 和 粘 接应 用 中 它 明 显 的 不 同 是 它 需 要 高 精度 的 
三 维 插 和 信物。 再 用 其 他 一 些 例子 来 说 明 主 要 概念 和 
技术 ， 以 及 自动 微 装配 系统 的 每 个 功能 单元 之 间 的 
逻辑 连接 。 

装配 的 任务 是 将 捡 取 的 微机 械 加 工 的 薄 金 属 转 
移 到 真空 托盘 的 组 装 工作 单元 ， 并 将 它们 插入 在 硅 
唱片 上 用 活性 离子 蚀刻 技术 蚀刻 的 垂直 的 洞 中 。 唱 
片 直 径 可 达 8in。 每 个 晶片 上 的 孔 形 成 规则 的 数组 ， 
每 个 晶片 约 有 50 个 孔 。 然 而 ， 这 些 阵列 可 能 不 会 规 
则 的 分 布 在 晶片 上 。 通 常 ， 每 个 晶片 由 数 百 个 零件 
组 装 。 一 般 情 况 下 ， 每 个 装配 操作 是 一 个 典型 的 矩 
形 栓 插 入 一 个 矩形 孔 的 问题 。 每 个 金属 部 件 是 小 于 
100um 厚 ， 约 半 毫 米 宽 ， 在 其 长 方形 的 一 角 。 总 的 
装配 容 差 通常 在 垂直 方向 小 于 10pm， 水 平方 向 小 
于 20pm。 这 个 工作 是 一 个 典型 的 3-D 微 组 装 技术 
的 应 用 。 


18.6.2 ” 微 装配 系统 设计 


本 节 从 机 器 人 系统 和 自动 化 的 角度 讨论 自动 微 装 
配 系 统 的 设计 。 要 达到 的 性 能 对 象 包括 : 高 可 靠 性 、 
高 吞吐 量 、 高 弹性 和 低 成 本 。 

1. 一 般 的 指导 方针 

以 系统 的 角度 来 看 ， 自 动 微 装配 系统 由 许多 功能 
单位 和 一 系列 领域 的 集成 技术 组 成 ， 这 些 领 域 涉 及 机 
器 人 学 、 计 算 机 视觉 、 显 微 镜 光 学 、 物 理学 和 化 学 。 
因此 考虑 这 些 单元 间 的 交互 是 非常 重要 的 。 

2. 重视 封装 过 程 的 耦合 

虽然 为 了 表述 的 清晰 度 ， 在 本 节 中 的 微 组 装 技术 
主要 是 从 机 器 人 的 角度 来 讲述 ， 但 机 器 人 系统 的 设计 
者 必须 意识 到 与 实现 机 器 人 系统 架构 设计 有 较 强 的 依 
赖 性 。 这 个 关系 应 该 从 系统 开发 初始 阶段 就 得 到 
强调 。 

3. 可 重 构 设 计 

自动 装配 机 器 的 设计 必须 使 它们 可 用 于 定制 各 种 
广泛 的 应 用 。 因 此 ， 可 重 构 性 是 一 个 基本 的 设计 要 
求 。 通 常 ， 基 于 功能 分 解 的 模块 化 设计 是 必需 的 。 支 
持 工 具 更 换 是 很 重要 的 。 

自动 微 装 配 系统 的 设计 是 强烈 依赖 于 装配 容 差 的 
需求 。 首 先 ， 运 动 控制 系统 的 可 重复 性 和 微 操作 系统 
的 使 用 是 由 装配 的 容 差 决定 的 。 其 次 ， 装 配 容 差 往往 
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决定 光学 显微镜 的 最 低 分 辨 率 。 一 般 的 微 装配 任务 可 
能 只 需要 微观 的 视觉 反馈 和 微 太 度 重 复 性 的 操纵 器 。 
而 复杂 的 微 装 配 任 务 可 能 还 需要 集成 微 力 和 视觉 
反馈 。 

自动 微 装配 系统 必须 能 够 支持 各 种 各 样 的 材料 处 
理工 具 ， 其 中 包括 部 分 传输 工具 、 批 量 馈 电线 、 唱 片 
RETE, AR AREAL AALS 
显 微 操 纵 融 的 作用 是 提供 多 自由 度 的 精细 运动 控 
制 。 微 夹 钳 的 作用 是 要 抓紧 物件 进行 挑选 和 放置 等 其 
他 装配 作业 。 它 们 的 效率 和 和 鲁 棱 性 将 在 很 大 程度 上 决 
定 了 整个 系统 的 性 能 。 微 夹 钳 的 设计 也 是 密切 地 与 微 
装配 业务 的 固定 装置 的 设计 相关 。 

主要 的 环境 因素 包括 洁净 的 房间 要 求 ， 以 及 温 
度 、 湿 度 、 气 流 等 。 某 些 装配 作业 必须 在 一 个 干净 
的 房间 里 执行 。 这 就 要 求 自 动 微 装配 系统 的 设计 符 


图 18.6 


4. 一 般 系 统 架 构 

一 个 自动 化 的 微 装配 系统 通常 包含 以 下 功能 
单元 。 

(D 大 工作 空间 定位 单元 ”在 大 多 数 微 装配 操 
作 中 需要 一 个 大 的 工作 空间 和 远 距离 定位 运动 。 为 了 
适应 不 同 的 功能 单位 ， 部 分 馈 电 线 、 各 种 工具 ， 以 及 
大 的 工作 空间 是 必要 的 。 

一 般 来 说 ， 可 以 直接 采用 现成 的 运动 控制 系统 ， 
该 运动 控制 系统 是 由 自动 化 的 IC 封装 设备 开发 的 。 
对 于 在 18. 6. 1 小 节 中 描述 的 任务 ，DRIE 蚀刻 的 孔 分 
布 在 晶片 上 ， 直 径 达 8in。 这 就 要 求 装配 系统 有 一 个 


合 有 关 标 准 。 如 一 些 包 装 过 程 必须 在 高 温 下 进行 ， 
比如 共 晶 接合 。 因 此 ， 必 须 加 以 考虑 高 温 对 运动 控 
制 系统 和 显微镜 光学 的 潜在 影响 。 对 于 操纵 微型 物 
体 ， 如 温度 和 湿度 等 环境 条 件 能 对 粘 附 力 天 六 5 汪 有 
大 影响 。 因 此 ， 考 虑 环境 控制 系统 的 设计 往 
EHHI, 

【 例 】 装配 过 程 流程 。 

微机 械 加 工 的 金属 零件 〈 见 图 18. 6c) 被 水 平 转 
移 到 真空 释放 托盘 上 的 工作 单元 中 。 唱 圆 垂直 于 水 平 
面 放置 在 品 圆 贴 片 机 上 ( 见 图 18. 6b) 。 这 种 配置 因 
为 不 需要 薄 金 属 部 件 的 翻转 ， 有 可 靠 性 和 效率 方面 优 
势 。 在 每 一 个 装配 周期 主要 有 两 个 操作 : 捡 取 和 插 
入 。 在 如 图 18. 7a 所 示 的 配置 下 ， 所 有 操作 都 是 由 相 
同 的 工作 单元 执行 。 复杂 的 封装 操作 常常 须 进行 分 
解 ， 由 多 个 工作 单元 执行 。 
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三 维 中 微 组 装 示例 
a) 释放 托盘 上 的 部 件 b) 与 美国 硬币 相对 比 的 部 件 c) 部 件 形状 d) 洞穴 e) 组 装 结果 


( 见 图 18. 7b) 。 唱 圆 贴 片 机 的 垂直 运动 是 由 20cm 长 
(8in) 和 重复 性 精度 Sum 的 线性 滑 轨 来 提供 。 它 也 
是 使 用 一 个 PID 加 前 馈 算法 来 控制 的 。XY 工作 台 和 
垂直 线性 滑 轨 都 使 用 交流 伺服 电动 机 驱动 。 唱 圆 贴 片 
机 的 旋转 是 由 最 高 分 辩 率 为 0.0028"/ 步 的 东方 
PK545AUA 微 步 电动 机 驱动 的 。 所 有 低级 别 的 控制 右 
都 是 由 一 台 主 机 指挥 和 协调 的 。 
对 于 需要 um 或 更 大 的 可 重复 性 的 应 用 程序 ， 
实施 粗略 范围 内 的 议案 ， 可 以 很 方便 地 使 用 传统 的 定 
位 表 。 这 些 台 子 通常 使 用 丝 杠 或 滚珠 丝 杠 驱动 器 和 滚 
珠 或 深 子 的 轴承 。 对 于 需要 亚 微米 级 或 纳米 重复 性 的 


相称 的 工作 空间 和 较 高 的 定位 速度 。 粗 糙 的 定位 单元 
有 4 个 自由 度 〈 见 图 18.7a) 。 在 水 平方 向 上 的 平面 
运动 是 由 一 个 开放 式 框 架 的 高 精度 32cm (12in) 的 
XY 表 提 供 的 ， 在 两 个 方向 上 的 重复 性 精度 为 1pm。 
分 辩 率 为 0. 1pm 的 位 置 反馈 是 由 两 个 线性 编码 器 提 
供 的 。 每 个 轴 使 用 双环 PID 加 前 馈 控制 方案 控制 。 内 
部 速度 环 是 邻近 于 电动 机 上 的 旋转 编码 器 上 。 外 部 位 
置 环 是 邻近 于 线性 编码 器 上 。 每 个 晶片 被 放置 在 垂直 


用 ， 有 几 个 解决 方案 也 得 到 商业 上 的 应 用 。 比 如 ， 
电 驱 动 带 常 常 被 用 于 纳米 重复 性 的 动作 。 压 电 驱 动 
的 缺点 是 它们 的 运动 范围 小 ， 通 常 在 100pm, 作为 
另 一 个 例子 ，Aerotech 可 以 提供 一 系列 基于 直接 驱动 
线性 执行 器 和 空气 轴承 的 具有 亚 微米 级 重复 性 的 定位 
平台 。 它 也 可 以 使 用 并 联结 构 机 构 ， 如 Stewart 平台 。 
在 一 般 情况 下 ， 对 深 亚 微米 级 集成 电路 制造 的 发 展 为 
这 些 运动 控制 技术 发 展 提供 了 主要 动力 。 
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的 唱 圆 贴 片 机 上 ， 它 可 提供 线性 和 旋转 两 类 控制 


(2) 微 操纵 器 单元 ”精细 的 方位 〈 位 置 和 方向 ) 
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图 18.7 正在 做 实验 的 微 组 装 工作 间 


a) 系统 整体 框架 b) 装配 现场 


控制 在 3-D 精确 对 齐 和 装配 等 任务 中 是 需要 的 。 比 
如 ，18. 6. 1 节 中 介绍 的 由 独立 结构 实现 的 任务 需要 6 
个 自由 度 。 三 个 笛 卡 儿 自 由 度 提供 了 一 个 适应 Sutter 
MP285 显 微 操 纵 咒 ， 还 提供 了 旋转 自由 度 〈 见 图 
18.7c) 偏 航 运动 。 横 滚 运动 是 在 唱片 上 安装 (ILA 


c) 微 操作 单元 


的 微 装配 任务 使 用 了 一 个 组 合 的 微 夹 钳 。 微 夹 钳 的 发 
展 往往 和 微观 尺寸 发 展 的 装置 密切 相关 。 

(4) 光学 显微镜 和 成 像 单 元 ”光学 显微镜 和 成 
像 单元 的 功能 是 提供 几何 形状 ， 运 动 和 装配 对 象 的 空 
间 关 系 的 非 接 触 式 的 测量 。 商 业 设备 系统 的 典型 配置 


18.7b) 实施 。 拾 音 器 后 的 金属 部 分 的 音 高 运动 是 通 
过 手动 调节 和 校准 装配 前 实现 。 经 过 拾取 后 金属 部 
件 的 俯仰 运动 不 是 靠 机 动 实现 的 ， 而 是 在 组 装 前 校 
准 后 通过 手工 调整 的 。 显 微 配置 的 更 多 讨论 可 见 
18. 61 节 。 

在 实施 自动 的 3-D 微型 组 装运 动 控 制 时 需要 考 
虑 两 个 原则 。 首 先是 大 的 工作 区 的 粗 定 位 装置 和 精细 
定位 显 微 单元 的 划分 。 其 次 是 多 个 自由 度 的 分 解 和 分 


是 使 用 一 个 或 两 个 垂直 的 显微镜 。 倒 置 显微镜 配置 常 
用 于 背面 对 齐 。 另 一 方面 ,3-D 微 装配 可 能 需要 有 立 
体 视 觉 的 两 个 摄像 头 的 配置 。 在 图 18. 7a 所 示 的 系统 
中 ， 可 以 提供 四 种 不 同 的 视觉 以 进行 人 为 操作 : 整个 
装配 现场 的 一 个 全 局 视图 ， 一 个 是 部 分 拾取 时 的 垂直 
的 微观 视图 ， 两 个 是 用 于 最 后 微 装配 操作 时 的 精确 定 
位 和 方向 调整 的 侧面 微观 视图 。 每 个 视图 使 用 匹配 光 
学 系统 的 CCD 相机。 所 有 图 像 都 用 Matrox Corona PCI 


布 实施 。 在 实践 中 ， 这 些 原 则 的 实际 实现 高 度 依赖 于 
具体 应 用 。 对 于 某 些 应 用 ， 如 果 一 个 大 范围 的 定位 单 
元 足以 满足 装配 公差 要 求 ， 甚 至 可 能 是 不 必 单 独 实施 
一 个 显 微 操 作 需 。 一 般 情况 下 ， 分 离 一 个 显 微 操 作 单 
元 ， 将 有 利于 实施 高 带宽 的 运动 控制 。 然 而 ， 通 常 这 
种 分 离 也 带 来 了 整个 运动 控制 系统 的 元 余 。 高 精密 显 
微 操作 的 运作 也 必须 依赖 于 闭环 的 反馈 控制 ， 特 别 是 
微观 的 视觉 反馈 。 

(3) 自动 微 抓 取 单 元 ” 微 夹 钳 的 功能 是 在 拾取 
放置 上 提供 几何 和 物理 上 的 限制 和 装配 操作 。 微 夹 钳 
的 可 靠 性 和 效率 对 全 自动 化 微 装配 系统 性 能 的 影响 是 
至 关 重 要 的 。 显 微 操 纵 器 设计 中 必须 考虑 的 几 个 因 
素 。 首 先 ， 作 为 微型 操纵 器 的 末端 执行 器 ， 微 夹 钳 必 
须 在 显微镜 下 进行 不 断 的 监测 。 因 此 ， 必 须 体积 小 ， 
并 且 具 有 合适 的 形状 ， 以 便于 留 在 显微镜 的 视野 ， 并 
最 大 限度 地 减少 阻塞 。 其 次， 考虑 不 同 的 主流 物理 
学 ， 人 研究 各 种 抓 取 的 力 是 很 重要 的 。 第 三 ， 部 分 抓 取 
放置 和 装配 这 两 个 部 分 都 使 用 了 微 夹 钳 。 由 于 装配 操 
作 通 常 需要 更 多 的 约束 ， 设 计 抓 取 放置 操作 的 微 夹 钳 
未 必 适 合 于 装配 操作 。 事 实 上 ， 在 18.6.2 节 中 展示 


图 像 采集 卡 采集 。 

3-D 对 齐 的 关键 是 显 微 视觉 反馈 。 只 要 分 辨 率 符 
合 装配 的 要 求 ， 那 么 光学 显微镜 就 能 达到 更 大 的 工作 
距离 。 对 于 18.6.1 节 提 到 的 装配 任务 ，Edmund Sci- 
entific VZM 450i 变焦 显微镜 用 1 x 物镜 来 提供 正确 的 
视图 。 它 的 工作 距离 大 约 是 99mm, 分 辩 率 为 
7.5m, He HALA Hist? 0. 5 x 物镜 的 VZM450i 显 微 
镜 提供 ,来 指导 拾取 操作 。 其 视野 范围 可 以 从 
2. 8mm x2. 8mm 到 17. 6mm x17. 6mm。 它 的 工作 距离 
约 为 147mm。 

如 果 在 自动 装配 业务 中 需要 视觉 伺服 ， 必 须 加 上 
另 一 个 侧面 视图 形成 立体 结构 。 在 一 些微 装配 任务 中 
可 能 需要 更 高 的 分 辨 率 。 在 这 种 情况 下 ， 这 类 结构 用 
于 高 分 辩 率 光学 显微镜 。 例 如 ， 作 者 在 此 结构 中 使 用 
两 个 带 有 Mitutoyo 超 长 工作 距离 M Plan 的 Apo 10 x 
物镜 的 Navitar TenX 变焦 显微镜 。 每 个 显微镜 的 分 辩 
率 为 1um， 工 作 距 离 是 33.Smm。 因 此 ， 减 少 了 微型 
操纵 器 不 可 达 的 工作 范围 。 

全 局 视图 的 实现 是 使 用 缩影 Marshall V-1260 板 
的 摄像 头 ， 以 监控 整个 装配 现场 的 状态 。 在 帮助 操作 


338 第 2 篇 


机 器 人 结构 


imli 


者 了 解 总 的 空间 关系 ， 防 止 操作 失误 中 ， 它 起 着 
的 作用 。 

从 机 器 人 系统 的 角度 来 看 ， 对 于 复杂 的 3-D 微 
装配 操作 ， 自 动 微 装配 系统 的 发 展 将 依赖 于 以 下 的 
AE. 

1) 小 巧 的 、 鲁 棒 的 和 高 速 的 5 ~6 个 自由 度 的 微 
机 械 手 。 

2) 高 可 靠 和 高 效率 的 适合 在 显微镜 下 工作 的 微 
夹 钳 。 这 种 夹子 ， 应 该 有 主动 力 控制 或 被 动 柔 顺 ， 以 
避免 损坏 MEMS 器 件 。 

3) 三 维 显 微 计算 机 视觉 技术 、 三 维 微 力 测量 和 
控制 技术 以 及 集成 技术 。 


18.6.3 基本 的 微 装配 技术 


本 节 介 绍 几 个 自动 微 装配 系统 的 重要 支撑 技术 ， 
包括 机 器 视觉 技术 ， 微 力 控制 技术 ， 和 装配 策略 的 仿 
真 验证 。 

1. 机 器 视觉 技术 

机 器 视觉 技术 在 半导体 工业 有 着 广泛 的 应 用 。 
机 器 视觉 和 一 般 计 算 机 视觉 之 间 的 主要 区 别 在 于 ， 
不 同 于 自然 物体 和 场景 ,工厂 里 的 物体 和 场景 往往 
可 以 人 为 地 设计 和 配置 。 这 种 优势 往往 使 得 它 可 以 
显著 地 降低 复杂 性 和 提高 视觉 技术 的 鲁 棒 性 。 机 器 
视觉 技术 在 实时 处 理 上 的 需求 应 用 大 致 可 以 分 为 以 
下 基本 两 类 : 

(1) 非 实时 性 的 视觉 应 用 ”这些 应 用 程序 不 要 
求 高 带宽 的 实时 控制 的 视觉 反馈 ， 例 如 包括 物体 识别 
和 封装 质量 检验 。 

(2) 实时 性 的 视觉 应 用 “这些 应 用 需要 实时 的 
视觉 反馈 。 例 如 视觉 引导 拾取 与 放置 、 对 齐 、 搬 和 人 
等 。 在 参考 文献 [18. 81] 中 介绍 3- D 计算 机 视觉 技 
术 。 在 参考 文献 [18. 82] 中 介绍 了 一 个 标准 的 视觉 
伺服 技术 。 

有 了 几 个 商业 的 软件 包 从 供应 商 中 可 以 直接 拿 来 使 
用 ， 如 Cognex, Coreco 图 {& fH National Instruments 
(美国 国家 仪器 公司 ) 。 

2. 微 力 控制 技术 

机 器 人 领域 对 力 控制 的 理论 已 经 进行 了 50 年 以 
上 的 研究 。 一 些 理论 框架 和 许多 控制 算法 已 经 被 提议 
并 通过 了 实验 验证 ,已 开发 了 多 种 宏观 的 多 自由 度 的 
FG o 

力度 控制 对 微 组 装 也 是 十 分 关键 的 。 例 如 ， 在 设 
备 键 合 时 的 接触 力 ， 必 须 经 常 进行 编程 和 精确 控制 。 
在 一 般 情况 下 ， 很 多 宏观 力 控 制 技 术 可 以 应 用 在 微 / 
中 尺度 上 。 设 备 接触 力 控制 实质 上 是 一 维 的 ， 涉 及 几 


p 


= 


牛顿 的 力 。 另 一 方面 ， 在 操纵 微 / 中 尺度 部 分 ， 相 互 
作用 力 的 大 小 一 般 为 微 牛 到 毫 牛 之 间 。 这 种 级 别 的 力 
往往 统称 为 微 力 。 实 施 微 力 控制 技术 的 一 个 主要 挑战 
是 缺乏 多 自由 度 的 微 力 传感器 。 一 个 多 自由 度 的 微 力 
传感器 的 基本 要 求 是 ， 它 们 在 大 小 上 必须 是 微型 的 。 
制造 这 些 传感器 通常 需要 使 用 微机 械 加 工 技术 ， 包 括 
MEMS 技术 。 有 两 个 主要 的 微 力 传 感 配置 : 

(1) 独立 力 传感器 ”这 种 结构 的 优点 是 ， 该 传 
感 器 是 通用 的 ， 可 与 不 同 的 微 抓 取 器 使 用 。 大 部 分 安 
观 尺 度 的 多 自由 度 力 传感器 属于 这 种 类 型 。 然 而 ， 这 
也 要 求 传感器 具有 足够 的 结构 硬度 ， 来 支持 微 夹 钳 的 
静 载 荷 ， 这 往往 比 力 分 辨 率 大 的 多 。 
(2) 嵌入 式 力 传感器 “” 微 应 变 片 可 以 连接 到 微 
抓 取 器 。 力 敏感 材料 ， 也 可 以 用 在 微 抓 取 器 上 。 这 种 
配置 避免 了 静态 负载 的 问题 。 然 而 ， 这 种 力 感应 功能 
是 依赖 于 微 夹 钳 的 设计 ， 对 于 多 自由 度 的 微 力 /力矩 
测量 这 往往 不 一 定 是 最 佳 的 。 

复杂 和 高 精度 的 微 装配 任务 还 需要 集成 微 力 控制 
与 微观 机 器 视觉 。 简 单 的 集成 技术 有 门 控 / 开 关 方 
SEU US) 综合 的 方法 ， 可 使 用 视觉 阻抗 。 

3. 装配 策略 的 仿真 验证 

在 许多 微 装配 任务 中 ， 相 邻 装 置 之 间 的 距离 往往 
中 等 /微观 尺度 上 上。 因此， 选择 正确 的 装配 顺序 对 如 
免 碰 撞 是 很 重要 的 。 此 外 ， 由 于 显微镜 有 限 的 工作 距 
离 ， 微 装配 作业 必须 经 常 在 有 限 的 空间 使 用 微 控制 器 
进行 操作 。 为 了 避免 器 材 或 设备 损坏 ， 避 免 碰 撞 是 至 
关 重 要 的 。 使 用 离线 仿真 软件 可 以 发 现 并 避免 潜在 的 
碰撞。 许多 商用 的 离线 机 器 人 编程 工具 ， 可 以 提供 这 
种 功能 。 

4. 微 装配 工具 

在 自动 微 装配 系统 的 微型 操纵 器 的 末端 执行 器 往 
往 是 一 个 微 夹 钳 的 形式 ， 其 可 靠 性 和 效率 ， 极 大 地 影 
响 整个 系统 的 可 靠 性 和 效率 。 微 夹 钳 必 须 尽 可 能 的 
小 。 它 的 设计 还 必须 最 大 限度 地 减少 易 损 的 MEMS 
部 件 潜在 的 损害 。 在 结构 设计 上 这 往往 需要 被 动 
柔顺 。 
制作 成 带 有 集成 MEMS 驱动 器 的 微 抓 取 器 ， 从 
而 可 以 有 更 紧凑 的 大 小 。 一 些 物 理 效应 普遍 用 在 
MEMS 驱动 器 上 ， 包 括 静 电 引 力 和 压 电 式 力 [5 、 
SMA (EREE) 、 热 形变 ! ”1 目 
前 ， 主 要 的 限制 是 关于 MEMS 驱动 器 产生 足够 的 移 
动 、 力 、 输 出 功率 的 难题 。 或 者 ， 另 一 个 解决 方案 是 
提供 外 部 驱动 。 其 优点 是 有 足够 的 移动 和 力 ， 输 出 功 
率 可 以 更 容易 获得 。 主 要 缺点 是 ， 微 夹 钳 在 大 小 上 不 
够 紧凑 。 这 可 能 成 为 其 应 用 的 主要 障碍 。 
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18.7 微型 机 器 人 技术 


现在 ， 越 来 越 多 的 微型 机 器 人 在 各 个 领域 中 有 新 的 
应 用 。 除 了 微型 装配 ， 微 型 机 器 人 在 其 他 工业 领域 也 扮 
演 重 要 角色 ， 如 操控 、 表 征 、 检 查 和 维护 ， 以 及 在 生物 
技术 中 ， 例 如 可 以 操控 细胞 的 生物 微型 机 吉 人 领域 。 


18.7.1 微型 机 器 人 


微型 机 器 人 是 一 个 结合 了 已 建立 起 来 的 机 器 人 理 
论 与 技术 和 令 人 欣喜 的 新 型 工具 的 领域 ,该 新 型 工具 
是 由 MEMS 技术 提供 的 ， 是 为 了 创造 在 微米 范围 里 
操作 的 智能 机 器 。 正 如 概述 微型 机 器 人 领域 的 作者 所 
BEE) ， 许 多 微观 条 件 ， 例 如 微型 机 电学 、 微 观 
机 械 制造 、 微 型 机 械 和 微型 机 器 人 都 用 来 说 明 许多 设 
备 的 功能 都 是 与 小 尺寸 有 关 的 ， 无 论 如 何 小 尺寸 是 一 
个 更 清晰 定义 所 需要 的 相关 名 词 。 

宏观 机 器 人 和 微观 机 器 人 最 明显 的 差异 是 机 器 人 


微型 机 器 人 集成 定位 系统 一 > 


Q AP 
CED 
e) 
AP AP AM 
M t. 
QY 
b) f) 


无 操作 功能 的 微型 机 器 人 (控制 线 ) 
c) g) 


可 以 进行 操作 的 机 器 人 (控制 线 ) 


的 尺寸 。 因 此 ， 微 观 机 器 人 的 一 种 定义 是 : 一 种 比 通 
常 看 到 的 零件 有 着 更 小 尺寸 (例如 ， 微 米 级 相对 于 
毫米 级 ) 的 设备 ， 并 且 这 种 设备 有 着 在 微米 和 亚 微 
米 范 围 的 工作 空间 中 移动 、 施 加 作用 力 和 操作 物体 的 
能 力 0 2 。 然 而 ， 在 很 多 情况 下 ， 机 器 人 能 够 移动 
更 大 的 距离 也 是 很 重要 的 。 具 体 任务 的 定义 很 广 ， 包 
括 各 种 类 型 的 小 机 器 人 和 显 微 操作 系统 ， 显 微 操作 系 
统 是 在 尺寸 上 是 分 米 ， 但 可 以 进行 非常 精密 控制 
(微米 ， 甚 至 纳米 范围 ) US, 
除了 根据 任务 和 大 小 分 类 ， 微 型 机 器 人 也 能 根据 
移动 性 和 功能 分 类 ”1 。 许 多 机 器 人 通常 由 传 感 
器 和 执行 器 、 控 制 单元 和 电源 组 成 。 

根据 这 些 元 件 的 布置 ， 微 型 机 器 人 的 评价 标准 
是 : 运动 和 定位 的 可 能 性 (是 或 否 )、 操 控 的 可 能 性 
(是 或 否 )、 操 控 类 型 (TARAR) 和 自治 。 图 
18. 8 结合 四 个 指标 * ”描述 了 15 种 可 能 的 不 同 微 
型 机 器 人 的 配置 。 
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用 来 操作 的 无 线 微型 机 器 人 自动 化 操作 机 器 人 
k) 0) 


图 18.8 根据 功能 的 微机 器 人 分 类 


正如 图 18.8 所 描述 的 ( 取 自 参考 文献 
[18. 30] ) ， 分 类 主要 依赖 于 以 下 微型 机 器 人 组 件 : 
控制 单元 (CU) 、 电 源 (PS), ， 对 于 移动 机 器 人 必需 
的 驱动 器 (例如 ， 对 于 机 器 人 移动 和 定位 的 驱动 ; 
定位 执行 器 (CAP) ， 对 于 机 器 人 操作 必需 的 驱动 器 
(例如 ,机 器 人 手臂 的 控制 ;操作 执行 器 (AMD). 


注 : CU; 控制 单元 ; PS: 电源 ; AP: 定位 执行 器 ; AM: 操作 执行 器 


除了 不 同 的 驱动 器 功能 ， 感 知 功能 也 是 必需 的 ， 例 
如 ， 触 觉 传感器 在 微 抓 取 或 者 电荷 耦合 器 件 ( CCD) 
相机 内 镜 的 应 用 (比较 图 18. 8d 和 图 18.8a) 。 

最 终 的 目标 是 创建 一 个 完全 自主 的 如 图 18.8 所 
示 装 备 合适 的 微型 工具 的 无 线 移动 微型 机 器 人 。 因 为 
这 是 个 很 困难 的 任务 ， 一 个 好 的 开始 就 是 去 调查 制作 
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机 器 人 结构 


硅 元 素 微型 机 器 人 平台 和 研究 他 们 的 运作 能 力 的 可 能 
性 ， 该 平台 是 通过 电线 来 操控 和 提供 动力 的 ， 如 图 
18. 8c 所 示 。 

根据 图 18. 8a， 大 多 数 基 于 微型 机 器 人 设备 的 
MEMS 产品 发 展 至 今 可 以 归 类 为 可 移动 链接 一 一 微 玻 
RARE) sw Fe CAE OS) ， 如 图 18. 8e 所 
示 。 在 关于 移动 微型 机 器 人 研究 的 出 版 物 中 ， 大 多 数 
出 版 物 陈述 了 微型 运输 系统 (ULB 18. 8b) 9 0m, 
机 器 人 用 外 部 设备 来 进行 移动 ， (对 照 图 18.8b，f， 
j，n) 。 根 据 Fatikow 和 Rembold 5? ， 许多 人 研究 人 员 
正 致力 于 在 人 类 血管 移动 微型 机 器 的 方法 ， 然 而 ， 微 
型 机 器 人 很 难 控 制 ， 半 自动 化 系统 的 一 个 例子 就 是 所 
谓 的 智能 药丸 厘米 大 小 的 药丸 ,不 但 配备 有 摄像 
KUSIS ， 而 且 还 可 以 测量 人 体内 的 温度 或 者 是 pH 
[ELSA 。 香 下 药丸 后 ， 该 药丸 输送 到 人 体 想 要 测 
量 或 者 记录 视频 序列 的 地 方 。 最 后 输出 摄像 机 测量 的 
参数 的 信息 或 者 信号 。 较 复杂 的 一 些 方法 就 需要 为 各 
种 不 同 的 给 药方 式 配 备 执行 器 ”中 。 通 过 X 光线 
检测 仪 或 超声 波 来 定位 体内 药丸 的 位 置 。 一 旦 药丸 到 
达 受 感染 的 区 域 ， 封 装 在 药丸 中 的 药 通过 板 上 的 执行 


结果 表明 基于 MEMS 技术 批量 生产 的 机 器 人 能 够 实 
现 自主 行走 (EMEKI EEA A HDR, Bk 
者 通过 遥控 充电 ) 。 在 1999 年 第 一 批 批量 制造 的 基于 
MEMS 的 微型 机 器 人 平台 能 够 行走 ， 然 而 ， 这 种 机 器 
人 是 通过 电线 供电 ， 并 没有 装备 执行 机 构 。 除 了 步行 
微型 机 器 人 设备 ， 许 多 关于 飞行 机 器 人 和 游泳 机 器 人 
的 报告 也 已 经 发 表 了 。 利 用 LIGA (高 精度 光 刻 平版 
技术 ) 技术 来 制作 的 微 马达 和 齿轮 箱 被 用 来 建造 微 
型 直升机 ， 这 种 微 直 升 机 可 以 从 德国 美 因 菊 显 微 技术 
研究 所 购买 作为 相当 昂贵 的 示范 对 象 "“""。 除 了 纯 
机 械 微 机 器 人 ， 机 电 组 件 与 生物 体例 如 虹 螂 组 成 的 混 
合 系统 也 时 有 报道 "1。 


18.7.2 生物 微型 机 器 人 


生物 操控 必然 华 有 如 定位 、 抓 取 和 注入 原料 到 细 
胞 的 各 个 位 置 等 操作 。 生 物 微型 机 器 人 的 研究 主题 包 
括 单个 细胞 或 分 子 的 自主 操作 ， 利 用 集成 视觉 和 力 传 
感 模块 的 微型 机 器 人 系统 的 生物 膜 机 械 特征 描述 等 。 
目标 是 在 生物 操控 和 细胞 的 损伤 研究 中 ， 获 得 基本 的 
关于 单 细 胞 生物 系统 的 理解 和 提供 关于 可 变形 细胞 跟 


器 释放 出 来 。 在 外 部 可 以 通过 无 线 电 波 来 完成 通信 。 
关于 通过 MEMS 技术 和 批量 技术 制造 的 步行 微 
型 机 器 人 ， 我 们 提出 了 很 多 重要 的 结论 。 并 对 表面 微 
机 械 机 器 人 和 压 电 的 干 反应 离子 蚀刻 机 器 人 提出 了 不 
同 的 方法 。 针 对 于 机 需 人 控制 的 合适 的 低 功 耗 专用 集 
成 电路 (ASIC) 已 经 通过 了 测试 ， 并 计划 整合 到 步 
行 微型 机 器 人 58 。 大 型 的 欧洲 智能 工程 MINIMAN 
(1997) 提出 了 发 展 移动 微型 机 器 人 平台 的 目标 ， 该 
平台 拥有 完整 的 6 个 自由 度 应 用 工具 ， 例 如 包含 于 
SEM 的 微 组 件 ， 来自 于 欧洲 几 所 大 学 和 公司 的 不 同 
的 MEMS 研究 组 参与 了 该 工程 。 此 外 ， 具 有 MEMS/ 
MST ( 微 系统 技术 ) 组 件 的 微型 机 器 人 组 件 已 经 研发 
Hoey 。 
早 在 20 世纪 90 年 代 ， 美 国 研 究 人 员 就 已 经 发 表 
了 关于 微型 机 器 人 的 研究 书籍 和 MEMS 微型 机 器 人 
的 传感器 技术 ; 日 本 的 几 组 人 员 目 前 正在 开发 基于 
MEMS 设备 的 小 型 化 机 器 个 。 在 日 本 ,国际 贸易 
和 工业 部 (MITI) 支持 了 一 个 持续 十 年 关于 微型 机 
技术 的 大 规模 项 目 ， 此 计划 开始 于 1991 年 。 这 个 项 
目的 最 终 目 标 是 为 微型 工厂 、 医 疗 技术 和 维修 应 用 创 
造 小 型 化 的 机 器 人 。 在 这 个 项 目 中 ， 包 括 运动 机 器 人 
和 微型 输送 机 器 人 在 内 的 很 多 微型 机 器 人 设备 已 经 生 
产 出 来 了 。 对 于 运动 任务 , 包含 MEMS 组 件 的 微型 
机 器 人 设备 或 车 辆 也 已 经 实现 了 。 尽 管 通过 
MEMS 技术 努力 实现 机 器 人 微型 化 ， 但 仍然 没有 试验 


踪 生 物 膜 的 机 械 特 征 模型 。 

现 有 的 生物 操控 技术 ,可 分 为 非 接 触 式 操控 
(包括 激光 诱捕 和 电 转 动 ) 和 接触 式 操控 ( 称 为 机 械 
显 微 操控 ) 。 当 激光 诱捕 天 天 2 用 于 非 接触 式 的 生 
NRE IS PE ， 激 光束 通过 一 个 大 数字 光圈 物镜 聚 
焦 、 汇 合 ， 形 成 一 个 光学 陷阱 ， 陷 阱 的 侧 力 会 使 悬浮 
液 中 的 细胞 向 光束 的 中 心 移动 。 纵 向 捕捉 力 使 细胞 向 
焦点 方向 移动 。 光 阱 使 细胞 悬浮 并 保持 它 的 位 置 。 激 
光 陷 阱 可 以 以 良好 的 控制 方式 工作 。 然 而 ， 这 两 个 特 
正 使 得 激光 捕捉 技术 不 适合 于 细胞 自动 注射 。 水 溶液 
FP 的 可 见 光 的 高 功 耗 要 求 需要 使 用 高 能 量 的 光 ， 以 至 
于 接近 紫外 光谱 ， 提 高 了 损害 细胞 的 可 能 性 。 尽 管 一 
些 研 究 人 员 声 称 ， 使 用 在 近 红 外 (IR) JERU pg 
波长 ， 这 样 的 顾虑 是 可 以 克服 的 ， 但 是 和 人 射 激光 束 是 
和 否 会 诱发 细胞 的 遗传 物质 的 异常 现象 的 问题 依然 存 
在 。 激 光束 的 一 种 替代 方法 是 电场 诱导 旋转 技术 。 
Mischel ^ 7?! — Arnold!'® ?7 和 Washizu ® 2 已 经 证 明 
了 细胞 的 电场 诱导 旋转 。 非 接触 式 细胞 操控 技术 是 基 
于 相 移 的 控制 和 电场 的 幅度 。 适 当地 应 用 电场 ， 将 产 
生 细胞 的 扭转 。 基 于 这 个 原则 >" ， 为 细胞 操控 
建立 不 同 的 系统 配置 ， 即 可 实现 细胞 高 精度 定位 。 然 
而 ， 由 于 缺少 使 细胞 保持 位 置 以 便 进一步 处 理 例如 注 
射 的 手段 、 由 于 电场 的 幅度 必须 保持 在 较 低 水 平 才能 
确保 细胞 的 活性 、 由 于 非 接触 式 生 物 操控 技术 ， 如 激 
光 诱 捕 和 电场 诱导 旋转 技术 中 的 局 限 ， 使 得 显 微 操 作 
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法 成 为 现实 。 通 过 机 械 显 微 技术 ， 在 激光 诱捕 技术 中 
的 激光 束 带 来 的 损害 和 在 电场 诱导 旋转 技术 中 缺乏 保 
持 位 置 的 缺陷 都 能 够 被 克服 。 

为 了 改善 成 功率 很 低 的 手工 操作 ， 并 消除 污染 ， 
自主 的 机 器 人 系统 (如 图 18.9 所 示 ) 已 发 展 到 可 以 
将 DNA 植 入 到 小 鼠 胚 胎 的 两 个 核 中 的 一 个 ， 而 不 需 
要 细胞 溶液 。 实 验 室 的 实验 结果 表明 ， 自 主 的 胚 原核 
DNA 注入 的 成 功率 比 传统 的 手动 注射 方法 有 着 很 大 
的 提高 。 自 主机 器 人 系统 采用 了 混合 控制 器 ， 该 混合 
控制 占 结 合 了 视觉 伺服 ， 精 确定 位 控制 和 模式 识别 来 
检测 细胞 核 及 实现 精确 的 自动 对 焦 。 图 18. 10 说 明 注 
射 的 过 程 。 
细胞 控制 单元 


T 


三 自由 度 的 微型 机 器 人 


逆 置 显微镜 
1 


E 18.9 带 有 视觉 和 力 反馈 的 机 器 人 生物 操纵 系统 


为 了 实现 大 规模 的 注射 操作 ， 通 过 阳极 唱片 键 合 
技术 制造 出 来 了 一 种 MEMS 细胞 保持 器 。 在 细胞 保 
持 器 上 ， 分 布 有 排列 好 的 孔 ， 这 样 就 可 以 将 单个 细胞 


20um 


图 18.10 细胞 注射 过 程 
a) b) 小 鼠 卵 母 细胞 透明 带 (ZP) 


保持 和 固定 住 以 便于 注射 。 在 计算 准确 的 情况 下 ， 带 
有 细胞 孔 的 系统 使 得 通过 位 置 控制 向 大 量 细胞 注射 成 


为 可 能 。 细 胞 注射 操作 可 以 使 用 移动 -注射 -移动 的 方 
式 进 行 。 


一 次 成 功 的 注射 取决 于 注射 的 速度 、 轨 迹 以 及 作 
用 到 细胞 上 的 力 。 为 了 进一步 提高 机 器 人 系统 的 性 
能 ， 一 种 基于 电容 性 细胞 力 传感器 的 多 轴 MEMS 系 
统 被 设计 并 制造 出 来 ， 从 而 能 够 将 实时 的 力 反 馈 到 机 
器 人 系统 中 。MEMS 细胞 力 传感器 同时 也 对 生物 机 械 
性 能 特征 的 研究 有 所 帮助 。 

图 18. 11 中 的 基于 两 轴 MEMS 细胞 力 传感器 能 够 解 
决 作用 于 细胞 的 正常 的 力 ; 以 及 由 于 不 准确 的 细胞 探测 
器 而 产生 的 切线 方向 的 力 。 一 种 高 产 的 微 制造 工艺 已 经 
发 展 起 来 ， 通 过 在 绝缘 硅 唱 圆 片 (SOI) 深度 蚀刻 
(DRIE) 可 以 形成 3-D 高 纵横 比 结 构 。 外 部 约束 框架 以 
及 内 部 移动 框架 由 4 个 弯曲 弹簧 连接 。 作 用 在 探头 上 的 
负载 会 引起 内 部 结构 的 移动 ， 从 而 引起 每 对 交错 梳 型 电 
容 之 间 的 缝隙 发 生 改 变 。 因 此 ， 总 电容 的 改变 将 取决 于 
作用 力 。 叉 合 电容 垂直 相交 ， 从 而 使 得 传感器 能 够 同 
时 检测 x 方向 以 及 y 方向 的 力 。 在 试验 中 细胞 力 传 感 
器 能 够 检测 到 最 大 2SuN 精度 可 以 达到 0. 01 uN, 


可 移动 框架 


端 部 几何 形状 影响 着 力 的 定量 测量 结果 。 标 准 的 
注射 管 (Cook K-MPIP-1000-5) 端 部 区 域 拥 有 一 个 
直径 Sum 的 针尖 ， 此 注射 管 附属 于 细胞 力 传感器 的 


i a 


20hm 1000X 8 


图 18.11 带 有 垂直 梳 状 驱动 器 的 蜂窝 力 传感器 


机 器 人 系统 以 及 高 精度 的 细胞 力 传感器 同时 也 
被 应 用 到 生物 机 械 性 能 的 研究 中 “"” 。 其 目标 是 获 
得 一 个 可 以 描述 当 外 部 负载 作用 到 细胞 上 后 细胞 膜 
的 变形 行为 的 一 般 参 数 模 型 。 此 参数 模型 服务 于 两 
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个 目的 。 第 一 ， 在 机 器 人 细胞 操控 中 ， 它 允许 在 线 
参数 辨识 ， 从 而 可 以 预知 细胞 膜 变 形 行为 。 第 二 ， 
在 对 细胞 的 损伤 以 及 恢复 研究 中 ， 对 细胞 膜 损伤 的 
热力 学 模型 非常 重要 的 是 可 以 识别 细胞 膜 的 机 械 行 
为 。 这 就 可 以 解释 如 下 已 经 报道 的 现象 ， 如 在 脱水 
过 程 中 细胞 体积 收缩 过 程 的 机 械 阻 力 以 及 与 伤害 之 
间 的 联系 。 建 立 这 样 的 模型 将 非常 有 助 于 细胞 伤害 
的 研究 。 

试验 证 明 机 器 人 技术 以 及 MEMS 技术 在 生物 研 
究 中 扮演 重要 的 角色 ， 例 如 自动 生物 操控 任务 。 在 机 
器 人 技术 的 帮助 下 ， 整合 视 觉 与 力 传 感 模型 以 及 
MEMS 设计 制造 技术 ， 研 究 主要 集中 在 生物 膜 机 械 性 
能 模型 ， 变 形 细胞 跟踪 以 及 单 细胞 以 及 生物 分 子 
操控 。 


18.8 纳米 机 器 人 技术 


纳米 机 器 人 技术 描述 了 进一步 小 型 化 到 处 理 纳米 
级 别 的 事物 。 纳 米 机 器 人 技术 是 一 种 研究 纳米 级 别 机 


WAWER, WEAKER 


[的 机 器 人 ， 也 就 是 纳米 


机 器 人 ， 或 者 大 斥 才 机 器 人 但 能 够 操控 纳米 级 事物 或 


纳米 机 器 人 操控 。 纳 米 


者 拥有 纳米 级 分 辨 率 ， 也 就 是 
级 别 的 机 器 人 操控 在 结构 、 构 建 以 及 在 MEMS 装配 
纳米 级 别 块 等 是 一 种 前 沿 技 术 。 与 目前 发 展 的 纳米 制 
造 工 艺 相 结合 ， 实 现 了 一 种 复合 方式 ， 从 而 从 独立 的 
纳米 碳 管 和 SIGE/SI 纳米 卷 中 建立 MEMS 和 其 他 纳米 
机 人 装置 。 材 料 科学 、 生 物 科 学 、 电 子 学 以 及 机 械 传 
感 与 驱动 将 从 纳米 机 器 人 技术 中 受益 。 


18.8.1 纳米 操作 介绍 


纳米 操作 技术 ， 即 在 纳米 级 别 上 的 定位 和 /或 者 
力 控制 ， 在 纳米 技术 领域 是 一 种 关键 性 的 技术 ， 它 填 
补 了 了 自 上 而 下 和 自 下 而 上 策略 之 间 的 空缺 ， 而 且 它 可 
能 带 来 使 用 复制 技术 的 分 子 装配 器 的 产生 中。 这 
些 类 型 的 装配 需 被 当做 通用 的 设备 来 构建 更 多 种 类 的 
有 用 产品 ， 同 样 包 括 它们 的 自我 复制 。 

目前 ， 纳 米 操作 被 用 于 观测 物理 现象 、 生 物 学 的 
科学 探索 和 纳米 设备 原型 的 构建 。 这 是 纳米 材料 、 纳 
米 结构 和 纳米 机 制 的 一 种 性 能 表征 ， 是 制作 纳米 级 别 
上 的 物体 构建 的 基础 ， 是 纳米 设备 如 NEMS 装配 的 
基础 。 

纳米 操作 是 由 于 STM I! . AFMs US? 和 其 他 
类 型 的 SPMs 的 出 现 而 可 用 的 。 除 了 这 些 ， 光 狠 
(激光 诱捕 ) I7 mg EES PT 也 是 潜在 的 纳米 
操作 器 。 纳 米 机 器 人 操作 器 (NRMs) 2 的 特 


点 主要 有 三 维 定位 、 方 向 控制 、 独 立 驱 动 的 多 个 末 
端 执行 器 和 独立 的 实时 观测 系统 ， 并 可 以 与 扫描 探 
针 显微镜 集成 。NRMS 在 很 大 程度 上 增加 了 复杂 的 
纳米 操作 能 

图 18. 12 STM, AFM, NRM 技术 的 简要 比较 。 
STM 无 与 伦比 的 成 像 分 辨 率 ， 使 得 它 可 以 应 用 于 粒 
子 级 别 ， 如 原子 级 别 分 辩 率 。 由 于 它 受 限于 自身 的 二 
维 定位 和 操作 策略 ， 这 导致 它 不 能 进行 复杂 的 操作 ， 
也 不 能 在 三 维 空间 中 应 用 。AFM 是 另 一 种 类 型 的 纳 
米 操作 器 ， 它 可 用 于 接触 或 者 动态 模式 。 通 常 AFM 
常 被 用 于 通过 触摸 的 方式 来 移动 物体 。 其 操作 开始 于 
非 接触 模式 下 的 粒子 成 像 ， 一 个 典型 的 操控 开始 于 在 
非 接触 模式 下 的 粒子 成 像 ， 然 后 消除 振荡 电压 波峰 和 
扫除 与 整个 粒子 表面 接触 时 反馈 的 失效 。 


10 100 
物体 尺寸 /nm 


图 18. 12 纳米 机 械 手 比较 示意 图 


0.1 1 


机 械 的 推动 可 以 在 物体 上 产生 更 大 的 力 ， 因 此 可 
以 用 来 操作 相对 较 大 的 物体 。1 ~3 维 的 物体 可 以 在 2 
维基 板 上 被 处 理 。 然 而 ， 利 用 AFM 操作 单个 原子 仍 
然 是 一 个 巨大 的 挑战 。 通 过 分 离 成 像 和 操作 功能 ， 纳 
米 机 器 操作 器 可 以 获得 包括 旋转 方向 控制 在 内 的 更 多 
的 自由 度 ， 因 此 可 用 于 3-D 自由 空间 操作 的 0-D (对 
称 球 ) 至 3-D 物体 。 受 限于 电子 显微镜 较 低 的 分 辩 
率 ，NRMs 很 难 用 于 进行 原子 级 别 上 的 操作 。 然 而 ， 
他 们 的 机 器 人 能 力 ， 包 括 三 维 定位 、 方 向 控制 、 独 立 
驱动 的 多 个 末端 执行 器 和 独立 的 实时 观测 系统 ， 并 与 
扫描 探 针 显微镜 集成 ， 使 得 NRMs 对 复杂 纳米 操作 相 
当 有 应 用 前 景 。 
第 一 个 纳米 操作 实验 是 Eigler 和 Schweizer 于 
1990 年 开展 的 。 他 们 利用 一 个 STM 和 低温 下 的 材料 ， 
在 单 品 镍 表面 与 原子 精度 进行 佐 原 子 的 定位 。 操 作 使 
得 它们 自己 构造 基本 的 结构 。 实 验 结果 由 一 系列 著名 
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的 图 像 组 成 ， 这 些 图 像 显 示 了 35 个 原子 是 怎样 移动 
最 后 组 成 的 三 个 字母 : IBM 的 过 程 。 这 表明 确实 可 以 
操作 原子 |。 

一 个 纳米 操作 系统 一 般 包 括 作 为 定位 装置 的 纳米 
操作 器 、 作 为 观察 装置 的 显微镜 、 作 为 其 手指 的 包括 
探 针 和 狠 子 在 内 的 各 种 末端 执行 器 ， 以 及 各 类 传感器 
( 力 、 位 移 、 触 觉 、 应 变 等 )， 以 便于 操作 和 /或 确定 
对 象 的 属性 。 纳 米 操作 的 关键 技术 包括 观察 、 驱 动 、 
测量 系统 的 设计 和 制造 、 校 准 和 控制 、 通 信和 人 机 界 
面 的 设计 。 

纳米 操作 的 策略 主要 由 环境 -空气 、 液 体 或 真空 

决定 ， 其 次 由 对 象 和 观测 方法 的 性 质 和 规模 决定 。 图 
18.13 展示 了 显微镜 ,环境 和 纳米 操作 策略 。 为 了 观 
察 操作 的 对 象 ， 可 以 利用 STMs 的 亚 埃 分 辩 率 成 像 ， 
而 原子 力 显 微 镜 可 以 提供 原子 级 别 的 分 辩 率 。 它 们 都 
可 以 得 到 的 3-D 面 的 拓扑 结构 。 因 为 AFMs 可 以 观测 
邻近 环境 ， 它 们 提供 的 操作 生物 的 强大 工具 需要 一 个 
液体 环境 。SEM 的 分 辨 率 是 pnm 左右 ， 然 而 场 发 射 
扫描 电镜 的 分 辨 率 更 好 些 。SEM/FESEM 可 以 用 在 2 

4 


维 空间 中 对 物体 或 者 操作 器 的 末端 执行 器 进行 实时 观 
察 ， 大 型 超 高 真空 (UHV) 样品 室 可 以 提供 足够 也 
空间 来 容纳 多 自由 度 的 3-D 纳米 操作 器 。 然 而 ，2 维 
的 观察 特性 使 得 沿 电子 束 的 方向 难以 实现 定位 。 高 分 
辨 透射 电子 显微镜 (HRTEM) 可 以 提供 原子 分 辩 率 。 
然而 ， 狭 窄 的 超 高 真空 样品 室 使 得 难以 组 合 大 尺寸 
的 操作 器 。 原 则 上 ， 衍射 光学 显微镜 (OMS) 不 能 
用 于 纳米 级 (小 于 可 见 光 的 波长 )。 扫 描 近 场 OMS 


接触 式 操作 
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图 18. 13 显微镜、 环境 和 纳米 操作 策略 示意 图 


0.1nm inm 10nm 100nm lum 


(SNOMs) 打破 了 这 个 限制 ， 并 有 和 希望 成 为 纳米 操作 
的 实时 观测 设备 ， 特 别 是 邻近 环境 。SNOMs 可 以 与 
原子 力 显微镜 (AFMs) 相 结 合 ， 并 有 可 能 与 NRMS 
相 结合 进行 纳米 级 别 上 的 生物 操作 。 

纳米 操作 过 程 大 致 可 分 为 三 种 类 型 : 

1) 横向 非 接触 式 。 

2) 横向 接触 式 。 

3) 垂直 操作 。 

通常 ， 横 向 非 接触 式 主要 和 STM 一 起 用 于 操作 
超 高 真空 的 原子 和 分 子 ， 或 者 利用 光学 和 磁性 钞 子 在 
液体 环境 中 操作 生物 对 象 。 横 向 接触 式 ， 可 以 用 于 任 
何 环境 中 ， 它 通常 与 AFM 相 结 合 ， 但 是 在 原子 级 别 
上 进行 操作 相对 困难 。 垂 直 操 作 可 以 通过 NRMs 来 完 
成 。 图 18. 14 展示 了 这 三 种 基本 策略 的 过 程 。 
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图 18. 14 纳米 操作 基本 策略 
a) 横向 非 接触 式 纳米 操作 (滑动 ) b) 横向 接触 式 
纳米 操作 人 ERO c) 纵向 纳米 操作 (拾取) 
A、B、C… 一 末端 执行 器 ，A'、B’、C'… 一 表示 物体 的 位 置 ; 
1、2 ,3… 一 表示 末端 执行 器 的 动作 ; 
1'.2'.3“… 一 表示 物体 的 动作 
注 : 狠 子 可 以 用 来 进行 拾取 ， 但 是 一 般 不 能 用 来 进行 放置 。 


顶端 D 


横向 非 接触 式 运动 过 程 如 图 18. 14a 所 示 。 适 用 
RUS ”包括 远 距 离 的 由 针尖 接近 样品 产生 的 吸引 
Fi, 针尖 和 样品 之 间 的 偏 压 产 生 的 电场 诱导 领 
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SoS P89) ， 隧 道 电 流 局 部 加 热 或 无 弹性 隧道 振 
动量。 利用 这 些 方法 ,一些 纳米 设备 和 分 子 可 
以 被 装配 而 成 1。 激光 诱捕 (GRE) IE HERE 
子 可 以 用 于 纳米 生物 样品 中 的 非 接触 式 的 操作 ， 如 
DNA US 14.5] 等 。 

与 STMS 结合 的 非 接触 式 操作 提供 了 许多 可 能 的 
操作 原子 和 分 子 的 和 策略。 然而， 操作 碳 纳米 管 
(CNTs 的 ) 的 先例 还 未 出 现 。 

利用 AFM 在 一 个 表面 上 推 或 拉 纳 米 对 象 是 一 种 
典型 的 操作 ， 图 18. 14b 显示 了 这 种 方法 。 早 期 的 工 
作 表 明了 这 种 方法 的 有 效 性 ”131 。 这 种 方法 在 纳 
米 制造 和 生物 制造 中 也 得 到 证 明 '*'” 1。 虚拟 现实 界 
面 有 助 于 进行 此 类 的 操作 3， 也 可 能 会 为 其 他 
类 型 的 操作 创造 可 能 。 这 些 技术 被 用 在 纳米 管 表面 的 
操作 上 ， 以 下 的 章节 还 将 介绍 更 多 的 例子 。 

如 图 18. 14e 所 示 的 拾 放 任务 ， 因 其 主要 目的 是 
将 各 个 部 件 装配 成 一 个 设备 ， 所 以 在 三 维 纳米 操作 上 
有 着 重大 的 意义 。 纳 米 操控 主要 的 困难 是 如 何 实 现 工 
具 和 物体 之 间 的 有 效 控制 以 及 物体 和 基板 之 间 的 相互 
作用 的 有 效 控制 。 参 考 文献 [18.156] 在 微米 操作 
上 提出 了 两 种 策略 ， 经 过 实验 表明 这 两 种 策略 在 纳米 
操作 上 也 行 之 有 效 '“ ”I  。 第 一 种 策略 是 在 工具 与 放 
置物 体 的 基板 之 间 提 供 偏差 ， 从 而 产生 介 电 电泳 力 ， 
最 终 可 将 介 电 电 泳 力作 为 一 种 可 控 的 外 力 施加 于 工具 
和 物体 之 间 。 另 一 种 策略 是 修改 范 德 华 力 、 物 体 和 基 
板 之 间 的 其 他 分 子 与 表面 的 力 。 对 于 前 者 ， 原 子 力 显 
微 镜 及 辟 梁 是 一 种 理想 的 电极 ， 可 以 在 悬臂 和 基板 之 
间 产 生 一 个 不 均匀 的 电场 。 


18.8.2 ”纳米 机 器 人 操作 系统 


纳米 机 器 人 操作 器 是 纳米 机 器 人 操作 系统 的 核心 
组 件 。 用 于 三 维 操作 的 纳米 机 器 人 操作 系统 需要 纳米 
级 别 的 定位 分 辨 率 、 一 个 相对 较 大 的 工作 空间 、 具 
足够 多 的 包括 旋转 在 内 的 自由 度 、 可 用 于 3-D 定位 
和 方向 控制 的 末端 执行 器 和 用 于 复杂 操作 的 多 个 末端 
执行 器 。 

一 个 商业 的 纳米 操作 器 (MM3A) 被 安装 在 SEM 
的 内 部 ， 如 图 18. 15 所 示 。 这 个 操作 器 有 3 个 自由 
度 ， 并 有 纳米 级 分 辨 率 和 亚 纳米 级 分 辨 率 ( 见 表 
18.4)。 计 算 结果 表明 ， 当 在 关节 g/g,， 沿 着 4/B 方 
向 移动 或 者 扫描 时 ， 多 余 的 线性 运动 在 C 上 是 很 小 
的 。 例 如 ， 当 一 个 手臂 的 长 度 为 50mm 时 ， 当 在 4 方 
向 移动 5 ~ 10pm 时 额外 的 C 方 向 上 的 运动 只 有 0.25 ~ 
Inm 之 间 ， 这 些 错误 可 以 忽略 不 计 ， 或 通过 移动 关节 
p, 从 而 使 其 得 以 修正 ， 关 节 p, 有 0.25nm 的 分 辩 率 。 
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Æl 18.15 3876 SEM 中 的 纳米 机 械 手 (MM3A ) 
a) MM3A b) 安装 c) 动力 学 模型 


表 18.4 MM3A 的 规格 


条 HB 规 格 
q, p 的 操作 范围 240。 

Z 的 操作 范围 12mm 
TIER A 1077rad (5nm) 
IPER B 10 "rad (3. 5nm) 
分 辨 率 C 0. 25nm 

精细 扫描 范围 4 20pm 
精细 扫描 范围 B 15m 
精细 扫描 范围 C 1pm 

A, BEE 10mm/s 
C 的 速度 2mm/s 


图 18. 16 显示 了 一 个 纳米 机 器 人 操作 系统 ， 它 共 
有 16 个 自由 度 ， 配 备 三 个 或 四 个 原子 力 显微镜 作为 
用 于 操作 和 测量 的 末端 执行 器 。 定 位 分 辨 率 为 亚 纳米 
级 别 ， 并 且 短 线 在 厘米 级 别 。 操 作 系统 不 但 可 以 用 于 
纳米 操作 ， 而 且 可 以 进行 纳米 装配 、 纳 米 编制 、 纳 米 
加 工 。 四 探 针 的 半导体 测量 可 能 是 该 系统 执行 的 最 复 
杂 操 作 ， 因 为 必须 通过 使 用 四 个 机 器 人 独立 地 驱动 四 
个 探 针 。 随 着 纳米 技术 的 不 断 发 展 ， 可 以 对 纳米 操作 
器 进行 缩放 ， 并 可 以 在 真空 室 里 的 显微镜 内 置 更 多 自 
由 度 ， 也 许 分 子 的 操作 板 如 德 雷 克 斯 勒 所 梦想 的 是 可 
以 成 真 的 。 
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为 了 构造 基于 纳米 结构 的 多 壁 矶 纳米 管 (WNT), 
机 械 手 对 纳米 管 进行 定位 和 定向 来 制造 纳米 管 探 针 和 
发 射 器 ,利用 电子 束 诱导 沉积 (EBID) S HERH T 
焊接 ， 用 单 壁 碳 纳米 管 的 性 能 表征 来 供 选择 和 用 接合 
点 来 测试 连接 强度 。 

图 18. 16b 为 一 个 纳米 实验 室 。 纳 米 实 验 室 集成 
了 一 个 纳米 机 器 人 操作 系统 、 带 有 纳米 分 析 系 统 、 纳 
米 制 造 系统 、 并 可 以 操作 纳米 材料 ， 制 备 纳米 部 件 ， 
装配 纳米 设备 ， 还 可 以 进行 材料 、 部 件 和 设备 特性 的 
原 性 分 析 。 在 纳米 实验 室 里 的 纳米 操作 系统 为 创建 三 
维 空间 的 纳米 系统 打开 了 一 条 新 的 途径 ， 并 且 可 以 为 
新 的 纳米 编制 和 纳米 制造 过 程 提 供 机 会 。 


纳米 制造 系统 
纳米 指示 系统 
纳米 操作 系统 


b) 


Æ 18.16 纳米 机 器 人 系统 
a) 纳米 机 器 人 机 械 手 b) 系统 设备 


18.8.3 ”纳米 装配 
纳米 操作 是 纳米 装配 的 一 种 很 有 前 景 的 策略 。 纳 
米 装配 的 关键 技术 包括 纳米 级 别 上 的 部 件 的 创建 和 表 


示 、 带 有 纳米 分 辩 率 的 部 件 的 定位 和 方向 控制 ， 以 及 
有 效 的 连接 技术 。 纳 米 机 器 人 操作 ， 其 特点 是 有 多 个 
自由 度 对 位 置 和 方向 进行 控制 、 独 立 驱 动 的 多 探 针 和 
一 个 实时 观测 系统 , 在 3-D 空间 已 被 证 明 是 有 效 的 
组 装 纳 米 管 为 基础 的 设备 。 

CNTs 定义 良好 的 几何 结构 、 优 异 的 机 械 性 能 和 
非凡 的 电气 特性 ， 及 其 他 优秀 的 碳 纳米 管 的 物理 化 学 
性 质 ， 使 得 其 拥有 许多 潜在 的 应 用 领域 ， 特 别 是 在 纳 
米 电子 学 、NEMS 和 其 他 一 些 纳米 设备 上 。 对 于 纳 机 
电 系统 ， 纳 米 管 的 最 重要 的 特点 ， 包 括 其 纳米 的 直 
径 、 大 长 径 比 (10 ~ 1000)、TPA 规模 的 杨 氏 模 
ElSe) Dp Bg EUS) x8 ES Tia] BY PE SE TE BE 
优良 的 场 发 射 能 力 、 各 种 导电 率 、 高 导热 、 不 产生 热 
的 高 电流 承载 能 力 、 各 种 物理 或 化 学 变化 的 电导 的 灵 
人 敏 度 、 电 荷 诱 导 键 长 的 变化 。 

螺旋 3-D 纳米 结构 或 者 纳米 线圈 可 以 由 各 种 材 
料 合成 ， 包 括 斜 碳 纳 米 管 、 氧 化 锌 纳米 带 。 

最 近 提 出 一 个 构建 具有 纳米 尺寸 结构 的 新 方法 ， 
可 以 在 可 控 的 范围 内 进行 制作 。 其 结构 可 以 通过 自 上 
而 下 的 制造 过 程 来 实现 ， 在 此 过 程 中 一 个 拉 紧 的 纳米 
厚 的 异 质 双 层 卷曲 形成 一 个 具有 纳米 级 功能 的 3-D 
结构 。 螺 旋 的 几何 形状 和 具有 10nm ~ 10km 直径 的 管 
被 制造 了 出 来 。 由 于 它们 有 趣 的 形态 、 机 械 、 电 气 和 
电磁 特性 ， 它 们 可 以 被 用 于 NEMS 中 的 纳米 架构 中 ， 
其 中 包括 纳米 弹簧 、 机 电 传 感 器 '“"”、 磁 场 探测 器 、 
化 学 或 生物 传感器 、 磁 束 发 生 器 、 电 感 器 、 执 行 器 和 
高 性 能 的 电磁 波 吸收 剂 。 

对 NEMS 基于 单个 的 碳 纳米 管 和 纳米 线圈 的 关注 
越 来 越 多 ， 这 表明 了 建立 在 这 些 设 备 上 的 特定 位 置 的 
部 件 的 性 能 需要 得 到 提高 。 随 机 蔓延 '*'"  、 直 接生 
KESTI BagaeU* 176) er ra v ép EU A 
Arg :可 以 为 构建 这 些 设备 的 电极 上 的 碳 纳米 
管 进行 定位 。 然 而 ， 以 纳米 管 为 基础 的 结构 ， 纳 米 机 
器 人 组 装 仍然 是 在 原 位 构造 、 特 性 和 组 装 能 力 的 唯一 
的 技术 能 力 。 因 为 ， 编 造 的 线圈 和 它们 的 底层 并 不 是 
完全 独立 的 ， 纳 米 机 器 人 装配 是 目前 唯一 的 将 它们 装 
配 在 设备 内 的 方法 。 

1. 碳 纳米 管 的 纳米 机 器 人 装配 

在 表面 上 的 两 个 维度 进行 纳米 操作 的 首次 试验 是 
与 AFM 相 结合 ， 并 通过 联系 推动 基板 而 进行 的 。 图 
18.17 显示 了 二 维 推 的 典型 方法 。 尽 管 和 图 18. 14b 
相似 ， 但 是 同样 的 操作 产生 出 不 同 的 结果 ， 这 是 因为 
纳米 管 不 能 被 看 成 0 维 的 一 个 点 。 第 一 个 实验 是 
Lieber 和 他 的 同事 进行 的 ， 他 们 测量 了 纳米 管 的 力学 


PEAS 8°) 。 采 用 如 18. 17b 中 显示 的 方法 ， 他 们 将 纳 
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L 


米 管 的 一 端 固定 ， 然 后 推动 纳米 管 的 另 一 端 ， 从 而 使 
纳米 管 弯曲 。 也 可 以 利用 这 个 方法 对 过 度 拉 伸 下 的 碳 
纳米 管 的 行为 进行 研究 。Dekker 和 他 的 同事 们 提出 
了 图 18. 17c，d 显示 的 策略 ， 并 且 利 用 此 方法 获得 一 
个 扭 结 的 交界 处 和 交叉 的 碳 纳米 管 。 

Avouris 和 他 的 同事 们 将 这 种 技术 和 一 个 逆 过 程 
相 结合 ， 把 一 个 弯曲 的 管子 推 直 ， 实 现 了 管子 到 另 一 
个 位 置 的 平移 号] 以 及 测量 了 两 个 电极 之 间 的 电导 


率 *'™]。 这 个 技术 也 可 以 把 一 根 管子 置 于 另 一 根 管 
子 中 来 形成 一 个 具有 纳米 管 交叉 连接 ”的 单一 电 


子 转换 器 (SET) 。 推 -诱导 分 割 也 可 以 形成 纳米 
Agi 8o 。 两 个 弯曲 的 管子 和 一 个 直 的 管子 可 以 简单 
组 合成 希腊 字母 9。 为 了 研究 原子 水 平 上 的 动态 滚 
动 ,在 石墨 板 上 用 AFMUS "9! 来 滚动 和 滑动 纳米 管 
(如 图 18. 17e,，f 所 示 ) 。 除 了 推拉 方式 ， 另 外 一 种 非 
常 重要 的 过 程 就 是 压缩 。 通 过 压缩 表面 ， 可 以 获得 机 
械 属性 特征 “和 进行 数据 存储 ITI, 


图 18. 17 碳 纳米 管 的 二 维 操作 ( a ) 为 初始 状态 ， 
为 用 不 同 的 力 在 不 同 的 位 置 推 纳米 管 ， 使 得 纳米 管 
变形 如 b ) 、c) ,至 d ) 破裂 ， 或 者 如 e) 和 f) 移动 ) 


a) 初始 状态 b) 弯曲 c) 扭曲 
e) 滚动 f) 滑动 


在 3-D 空间 中 操作 碳 纳米 管 对 于 将 CNTs 集成 到 
框架 和 设备 中 是 非常 重要 的 。 纳 米 机 器 人 对 碳 纳米 管 
的 操作 的 基本 技巧 如 图 18. 18'*'31 所 示 ， 这 些 服务 
对 于 操作 、 构 造 、 描 绘 装配 NEMS 都 是 最 基本 的 。 

其 基本 做 法 是 从 碳 纳 米 管 的 烟灰 中 拿 起 单 管 
( 见 图 18.18a)。 这 个 可 以 通过 使 用 介 电 电泳 (双向 
电泳 ) AZAR LARA BETES oe 2 得 到 证 明 ( 见 图 
18. 18b) 。 通 过 对 锐利 尖端 和 平面 基板 之 间 提 供 偏差 ， 
可 以 在 针尖 与 基板 之 间 产 生 一 个 不 均匀 电场 ， 在 针尖 


d) 破裂 


附近 该 电场 是 最 强 的 。 这 个 不 均匀 电场 可 通过 电泳 或 
者 双向 电泳 引起 纳米 管 沿 着 电场 方向 移动 ， 其 至 跳 到 
针尖 上 (取决 于 目标 管 的 导热 性 )。 将 偏差 撤销 之 
后 ， 便 可 以 将 电子 管 放置 在 任何 想 放 的 地 方 。 这 种 方 
法 ， 可 以 用 在 碳 纳米 管 烟灰 的 独立 管子 上 或 者 用 在 通 
常 受到 的 范 德 华 力 较 微 弱 的 粗糙 表面 上 。 强 烈 根植 于 
碳 纳米 管 烟尘 的 电子 管 或 者 放 在 平面 上 的 电子 管 是 无 
法 用 这 种 方法 捡 起 来 的 。 电 子 管 和 原子 力 显微镜 悬臂 
尖端 平坦 的 表面 上 的 原子 之 间 的 相互 作用 是 可 以 将 电 
子 管 扒 起 并 放 到 尖端 上 上 的” ( 见 图 18.18c)。 通 
过 应 用 EBID， 有 可 能 拿 起 并 将 纳米 管 固定 到 探 针 
EUS! ( 见 图 18.18d)。 为 了 搬运 电子 管 ， 我们 需 
要 在 电子 管 和 探 针 之 间 实 现 弱 连接 。 

如 图 18. 18e, £ Brom, 弯曲 和 屈曲 碳 纳米 管 对 
于 描述 纳米 管 的 原型 是 非常 重要 的 3， 这 也 是 一 
个 获取 纳米 管 的 杨 氏 模 量 的 简单 方法 ， 该 方法 不 用 损 
坏 电子 管 就 取得 了 碳 纳米 管 的 杨 氏 模 量 (如 果 在 它 
的 弹性 范围 内 ) 。 因 此 ， 可 以 根据 不 同 的 特性 选择 电 
子 管 。 屈 曲 超过 其 碳 纳米 管 弹性 极限 ， 便 可 以 得 到 一 
个 扭 结 结构 '* ”1。 要 得 到 任意 角度 的 扭 结 点 ， 可 以 
在 它 的 弹性 极限 的 范围 内 使 用 EBID, 来 固定 纳米 扣 
的 形状 。 对 于 碳 纳米 管 ， 最 大 角 偏 移 将 出 现在 纯 弯 曲 
下 的 固定 左 端 或 者 纯 届 曲 下 的 中 间 点 。 在 这 两 种 组 合 
中 ， 负 蓓 将 达到 一 个 点 和 所 需 的 扭 结 角 度 的 可 控 的 扭 
结 位 置 。 如 果 在 碳 纳米 管 的 弹性 限度 内 变形 ， 它 会 释 
放 负 载 后 复苏 。 为 了 避免 这 种 情况 ， 可 以 在 扭 结 点 使 
用 EBID， 以 固定 形状 。 

在 两 个 探 针 之 间 ， 或 者 一 个 探 针 和 基 片 之 间 ， 拉 
伸 纳米 管 将 产生 许多 有 趣 的 结果 (ULL 18. 18g) 。 第 
一 个 实验 的 碳 纳米 管 的 3-D 纳米 操作 便 演示 了 这 种 
现象 ， 它 展示 了 断裂 机 制 并 测量 了 碳 纳 米 管 的 力 
REUSE) 。 在 可 控制 的 操作 中 打 碎 一 个 碳 纳米 管 ， 将 
会 产生 一 个 有 趣 的 纳米 器 件 。 这 种 技术 -破坏 性 
制 一 一 可 以 得 到 尖锐 和 分 层 结构 的 纳米 管 ， 也 可 以 改 
进 纳米 管 的 力度 控制 天 加 。 典 型 的 ， 分 层 及 尖锐 的 
结构 可 以 通过 这 种 方法 得 到 。 这 个 过 程 类 似 于 电 脉 
冲 呈 2 。 在 一 个 不 完全 破裂 的 碳 纳米 管 中 ， 可 以 观 
察 到 轴承 运动 ，'”。 实 验 显 示 层 间 的 摩擦 力 非 
ai NUS 195,196] " 

逆 过 程 ， 也 就 是 破碎 电子 管 的 接合 过 程 ( 见 图 
18. 18h) 。 该 机 制 是 在 破碎 电子 管 的 末端 进行 离子 沁 
KFF A HL 80577 。 基 于 这 种 有 趣 的 现象 ， 实 现 了 
机 械 化 学 的 纳米 机 器 人 装置 2 。 

对 于 纳米 元 件 的 使 用 ， 纳 米 管 的 装备 是 一 个 基础 
技术 。 最 重要 的 任务 为 纳米 管 的 连接 和 将 纳米 管 放 到 


T 
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图 18.18 纳米 机 器 人 对 碳 纳米 管 的 操作 示意 图 
a) 初始 状态 (基本 技术 就 是 从 CNT 灰尘 中 捡 起 一 个 纳米 管 或 者 从 一 个 出 事 的 阵列 中 拾取 ) 


基板 之 间 的 一 个 不 均匀 的 电场 产生 的 电泳 来 拾取 单个 独立 的 碳 纳米 管 ) 
g) hi 


e) 弯曲 f) 屈曲 
EB 出 现 的 所 有 异常 都 来 自 于 作者 的 试验 。 
面 接触 纳米 管 ， 


ik: d. e) Wh 
2. c), d) 为 探头 对 


电极 上 。 纯 的 纳米 管 电 路 097 是 由 不 同 的 直径 和 手 
性 的 纳米 管 互相 连接 的 ， 它 可 以 进一步 减 小 设备 的 规 
格 。 纳 米 管 分 子 间 和 分 子 内 的 连接 是 这 些 系统 '*'”] 
的 基本 构成 部 分 。 室温 (RT) 的 单 电 子 唱 体 管 
(SETs) ,一 个 短 的 ( 约 为 20nm) 纳米 管 剖 面 ， 
已 是 通过 AFM 诱导 局 部 障碍 进入 电子 管 而 产生 的 ， 
di E 够 观察 到 库伦 充电 过 程 。 通 过 两 个 单 臂 碳 纳米 
管 的 交叉 连接 (SWNTs) (半导体 的 /金属 的 ) 可 以 
制造 出 三 个 和 四 个 终端 电子 设备 到 20 。 一 个 中 断 的 
交叉 连接 ， 可 以 作为 一 种 机 电 非 易 失 性 存储 器 ”1 。 
虽然 某 些 种 类 的 连接 已 经 用 化 学 方法 合成 ， 但 是 
没有 证 据说 明 一 个 基于 自我 装置 的 方法 能 够 提供 一 个 


b) 通过 电泳 拾取 通过 探 针 和 
d) 通过 EBID 拾取 


c) 通过 范 德 华 力 拾取 
断裂 h) 连接 / 绑 定 


或 者 是 将 纳米 管 固定 到 针头 上 的 相同 的 操作 示意 。 


更 为 复杂 的 结构 。 也 可 以 用 SPMs 制造 接头 , 但 是 它 
受 限 于 二 维 面板 。 我 们 提出 的 基于 操作 的 三 维 纳米 机 
器 人 的 纳米 装配 ， 是 一 个 对 于 建造 纳米 接头 ， 再 通过 
这 些 接头 构建 更 为 复杂 的 纳米 设备 的 很 有 前 途 的 方法 。 

根据 组 件 的 种 类 (SWNTs 或 MWNTs) 、 几 何 结 
构 (V kink, I, X cross, T, Y branch, fl 3-D junc- 
tions), FEE (金属 的 或 者 半导体 的 ) 以 及 (不 同 
的 ) 连接 方法 (分子 间 连接 (通过 范 德 华 力 ，EBID 
bid 或 者 分 子 内 连接 (通过 化 学 键 连接 ) ) 5 
米 管 连接 可 以 分 为 不 同 的 类 别 。 这 里 我 们 展示 一 些 通 
过 强调 的 连接 方法 的 多 壁 碳 纳米 管 连接 。 这 些 方法 对 
T SWNT 连接 同样 高 效 。 图 18. 19 显示 CNT 的 连接 
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通过 范 德 华 力 (图 18. 19a) 构造 的 ， 由 电子 束 诱 导 
沉积 (图 18.19b) 连接 ; 并 利用 机 械 化 学 (图 
18. 19c) 键 合 而 成 的 。 


//MWMT (020 nm) 
MWMT (30 nm) 


Bundle of 2 
MWNTs 
J E 


EBID —€$ 
deposit 


| | 
RI=14nm R5-21 nm 
X70 000 100nm 


L3-2343nm 


mm) Push mm 


X27 000 lum 


c) 

Æ 18.19 碳 纳米 管 的 连接 点 
a) 利用 范 德 华 力 相 连接 的 碳 纳 米 管 

b) 碳 纳米 管 与 EBID 相连 接 

c) 碳 纳米 管 通过 化 学 反应 相连 


图 18. 19a 展示 了 一 个 由 范 德 华 力 连 接 的 T 形 接 
口 。 它 是 通过 摆 放 MWNT 上 的 针尖 到 另外 一 个 
MWNT 上 ， 直 到 形成 一 个 结 制作 而 成 的 。 这 个 结合 
可 以 通过 测量 剪 切 的 连接 力 来 检查 。 

EBID 提供 了 一 个 修补 的 方法 来 获得 比 通过 这 些 
范 德 华 力 的 连接 更 强 的 纳米 管 连接 。 因 此 ， 如 果 对 纳 
米 结构 的 力量 要 求 更 高 ， 便 可 以 得 到 应 用 EBID 来 生 
成 纳米 管 连 接 。 图 18. 19b 给 出 了 通过 上 BID 连接 的 一 
个 MWNT 结 点 ， 在 图 中 ， 上 面 的 MWNT 是 一 个 单一 
的 ， 直 径 为 20nm, F iii tt R MWNTs， 由 直径 


三 


很 强 的 连接 性 。 破 坏 性 的 制造 提供 了 一 种 在 破坏 试管 
的 末端 形成 悬挂 键 的 方法 。 一 些 悬 挂 键 ， 可 能 会 关闭 
邻近 原子 ， 但 通常 还 是 会 存在 一 些 键 是 处 于 悬挂 状态 
的 。 一 个 底 端 带 有 悬挂 键 的 纳米 管 可 以 很 容易 的 和 另 
一 个 纳米 管 相 连接 ， 而 形成 分 子 内 结 点 。 图 18. 19c 
给 出 了 这 些 结 点 。 

三 维 机 器 人 操作 为 构建 和 装配 纳米 管 成 纳米 设 
备 ， 提 供 了 一 种 全 新 的 方法 。 但 是 ， 目 前 纳米 操作 仍 
以 串 行 的 方式 在 主 从 控制 方式 中 发 挥 作用 ， 而 不 是 大 
规模 以 生产 为 导向 的 技术 。 然 而 ， 随 着 微观 物理 学 探 
索 的 进步 ， 合 成 纳米 技术 得 到 了 较 好 控制 ， 驱 动 器 更 
为 精确 ， 操 作 工具 更 为 有 效 ， 高 速 制 动 纳米 技术 成 为 
可 能 。 另 一 种 方法 可 能 是 并 行 装配 ， 由 定位 积木 的 探 针 
阵列 组 成 天 2 ， 我 们 提出 的 平行 EBBID， 同 时 它们 之 间 
可 以 相互 连接 等 。 下 一 步 的 计划 是 在 指数 实验 装配 上 取 
得 进展 ， 并 在 不 远 的 将 来 实现 自我 复制 的 装配 * 中 。 

2. 纳米 线圈 的 纳米 机 器 人 装备 
基于 纳米 线圈 的 NEMS 的 构造 涉及 增长 或 制造 的 
纳米 线圈 的 装配 ， 从 制造 的 角度 来 看 这 是 一 个 重大 的 
挑战 。 由 于 其 螺旋 的 几何 尺寸 、 高 弹性 、 单 端 固定 和 
在 湿 蚀刻 基板 附着 力 强 的 操作 线圈 ， 我 们 着 眼 于 纳米 
线圈 操作 的 独特 方面 ,安装 在 一 个 扫描 电镜 中 
(Zeiss DSM962) 使 用 机 械 手 (MM3A，Kleindiek) 的 
一 系列 新 的 过 程 已 被 提出 。 由 制造 的 SiGe/Si 的 双 层 
纳米 线圈 (厚度 为 20nm 无 铬 层 或 41nm He), H1 
D=3.4um) 是 可 以 操作 的 。 特 殊 工具 已 经 制作 好 ， 
包括 一 个 纳米 钩子 和 一 个 黏 性 探 针 。 纳 米 钩 子 是 通过 
控制 市 售 的 钨 丝 材质 的 尖锐 探 针 (Pico 探 针 的 T-4- 
10-1MM 和 T-4-10) 与 基板 相 碰 发 生 的 尖端 -碰撞 制 
成 的 ， 黏 性 探 针 是 将 尖端 浸入 一 个 双 面 的 扫描 电镜 的 


30nm 的 单一 的 CNT 挤 压 而 成 。 常 规 EBID 的 发 展 受 
限制 于 昂贵 的 电子 丝 和 低 生 产 力 。 我 们 提出 了 一 个 并 
行 的 EBID 系统 ， 因 为 碳 纳米 管 具有 优异 的 场 发 射 特 
PETS 8) ， 因 此 我 们 将 碳 纳米 管 作为 发 射 器 。 并 行 的 
EBID 可 能 性 已 被 提出 。 这 对 于 大 规模 制作 纳米 管 结 
点 ， 是 一 个 很 有 前 途 的 战略 ， 但 是 ， 在 某 些 情况 下 ， 
附加 的 材料 可 能 影响 纳米 系统 的 正常 功能 。 因 此 ， 
EBID 主要 用 于 纳米 结构 而 不 是 纳米 机 构 。 

不 用 添加 额外 的 材料 而 获得 更 强 结 点 ， 机 械 化 学 
纳米 机 器 人 装配 是 一 个 有 效 的 策略 。 它 是 基于 固 相 化 
学 反应 ,或 者 机 械 力 合成 ， 它 定义 为 化 学 合成 的 机 械 
系统 控制 ， 操 作 具 有 原子 级 别 精度 ， 可 以 指出 反应 点 
的 位 置 选择 '*"*。 拾 取 带 有 用 挂 键 的 原子 ， 而 不 是 
自然 的 原子 ， 它 可 以 更 容易 形成 主键 ， 并 具有 简单 但 


导电 胶带 中 形成 的 (Ted Pella, Inc. ) 。 
如 图 18.20 所 示 ， 实 验 表 明 ， 纳 米线 圈 可 以 通过 
横向 推 挤 从 芯片 得 到 释放 ， 也 可 以 用 纳米 钧 子 或 茜 性 
探 针 拿 起 ， 并 被 放置 在 另 一 个 探头 或 原子 力 显 微 镜 悬 
辟 梁 之 间 (Nano-probbe，NP-S)。 轴 向 拉 / 推 、 径 向 
压缩 /释放 ， 以 及 弯曲 /屈曲 也 被 证 明 。 这 些 进 展 都 显 
示 了 表征 线圈 状 纳米 结构 及 其 装配 的 纳 机 电 系 统 操作 
的 有 效 性 ， 否 则 它们 就 不 可 用 。 

基于 单个 纳米 线圈 的 纳米 器 件 的 配置 如 图 18. 21 
所 示 。 甚 臂 式 纳米 线圈 如 图 18. 21a 所 示 ， 可 以 作为 
纳米 弹簧 。 纳 米 电 磁铁 、 化 学 传感器 和 纳米 电感 涉及 
纳米 线圈 的 两 个 电极 之 间 的 桥接 如 图 18.21b 所 示 。 
机 电 传 感 器 可 以 使 用 类 似 的 配置 ,但 与 一 端的 末端 连 
接 到 一 个 可 移动 的 电极 如 图 18. 21 所 示 。 机 械 刚 度 和 
导电 性 ， 是 这 些 设备 必须 进一步 调查 的 基本 属性 。 
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图 18.20 纳米 机 器 人 操作 纳米 线圈 示意 图 
a) 初始 状态 b) 压缩 /释放 c) 挂 在 钓 上 往 上 拉 d) 从 侧面 推拉 e) 抓 取 f£) 放置 /插入 g) 弯曲 n) 推拉 
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图 18. 21 基于 纳米 线圈 的 设备 

a) 悬挂 式 〈 可 以 当做 纳米 弹 答 ) b) 桥接 式 (固定 ) (纳米 电磁 铁 ， 化 学 传感器 ， 用 纳米 线圈 连接 的 两 个 电极 而 成 
的 纳米 电感 器 ) c) 桥接 式 (可 移动 ) (机 电 传感器 可 以 利用 类 似 的 配置 而 成 ， 但 是 需要 一 端 连 到 可 移动 电极 上 ) 
d) 线圈 的 刚度 特性 e) 纳米 线圈 电流 -电压 曲线 示意 图 ( 是 这 些 设备 的 基本 特征 
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如 图 18. 20h 所 示 ， 轴 向 拉 可 以 用 来 衡量 一 个 纳 
米线 圈 的 刚度 。 通 过 对 一 系列 SEM 图 像 进 行 分 析 ， 
可 以 提取 AFM 针尖 位 移 和 纳米 弹 得 变形 等 ， 其 中 相 
对 位 移 是 从 AFM 的 针尖 探 尖 开始 测量 的 。 根 据 这 个 
位 移 数 据 和 已 知 的 原子 力 显 微 镜 的 甚 臂 梁 刚度 ， 纳 米 
弹 得 的 拉力 与 纳米 弹簧 变形 就 会 被 绘制 出 来 。 纳 米 弹 
得 的 变形 是 相对 于 第 一 个 测量 点 测量 的 。 这 是 必要 
的 ， 因 为 对 原子 力 显微镜 悬臂 梁 来 说 ， 在 纳米 弹 往 施 
加 的 合适 附加 力 必 须 得 到 验证 。 然 后 ， 它 是 不 可 能 返 
回 到 零 变形 点 的 。 反 之 ， 正 如 图 18.21d 所 示 ， 开 始 
于 零 力 和 零 变 形 的 计算 好 的 线性 弹 得 的 刚度 线 已 经 发 
生 偏转 。 

从 图 18.21 可 以 看 出 ， 据 估计 ， 弹 得 的 刚度 为 
0.0233N/M, 纳米 弹 得 的 线性 弹性 区 域 延 伸 到 了 
4. 5um 就 变形 了 。 一 个 指数 逼近 拟 合 非 线性 区 域 。 
当 施 加 的 力 达 到 0. 176uwN ， 纳 米 弹 竹 和 原子 力 显 微 镜 
悬臂 之 间 的 连接 出 现 断 裂 。 有 限 元 仿真 (ANSYS9. 0) 
用 来 验证 实验 数据 "i。 由 于 连接 的 准确 地 区 不 能 
从 SEM 图 像 确定 ， 根 据 纳米 弹簧 的 明确 的 臣 数 ， 模 
拟 器 分 别 进行 了 4 圈 、4.5 圈 、5 圈 的 实验 ,来 估计 
可 能 的 范围 。 在 进行 模拟 时 ， 纳 米 弹 得 的 一 端 是 固定 
的 ， 并且 在 男 一 端 施 加 沿 轴 的 0. 106kN 的 大 小 的 力 。 
模拟 结果 显示 ， 弹 簧 为 4 圈 时 的 刚度 为 0.0302N/M, 
5 圈 时 的 刚度 为 0. 0191NAM。 测 得 的 刚度 下 降 的 值 在 
高 于 最 低 值 的 22% 与 低 于 最 高 值 的 22. 8% 范围 之 内 ， 
它 非常 接近 一 个 4.5 转 的 纳米 弹簧 产生 的 刚度 值 ， 其 
大 小 为 0.0230N/M。 

图 18.21e 显示 了 具有 11 臣 的 纳米 弹簧 的 电气 特 
性 的 实验 结果 ， 该 实验 使 用 了 图 18. 20g 所 示 的 配置 。 
I-V 曲线 是 非 线性 的 ， 它 可 能 由 于 通电 加 热 引 起 的 电 
阻 变化 的 半导体 双 层 导致 的 。 另 一 个 可 能 的 原因 是 由 
热 应 力 引起 的 接触 导致 电阻 下 降 。 在 8. 8V 偏 压 
0. 159mA 被 认为 是 最 大 电流 。 高 电压 将 导致 纳米 弹 
簧 掉 落 。 从 快速 扫描 屏幕 的 SEM， 纳 米 弹 簧 探 针 延 
伸 观 察 周围 的 峰值 电流 ,不 至 于 使 电流 大 跌 。 在 
9.4V, 扩展 纳米 弹 自 被 分 解 造成 I-V 曲线 的 突然 


制造 和 特性 结果 显示 ， 螺 旋 纳米 结构 用 来 作 电 感 
器 是 非常 合适 的 。 和 国家 最 先进 的 微 电 感 相 比 ， 它 们 
允许 进一步 小 型 化 。 为 此 ， 高 摊 杂 的 双 层 和 一 个 额外 
的 金属 层 会 导致 所 需 的 电导 。 如 果 蜡 缩 后 ， 额 外 的 金 
属 电镀 到 螺旋 结构 ， 电 导 、 电 感 和 品质 因数 可 以 得 到 
进一步 的 提升 。 进 一 步 ， 一 种 半导体 的 螺旋 结构 ， 当 
用 结合 分 子 将 它 功能 化 时 ， 与 展示 的 其 他 类 型 的 纳米 
结构 一 样 ， 在 相同 原则 下 可 用 于 化 学 传 感 技术 。 由 于 


eal 


E 


双 分 子 膜 在 几 个 层次 内 变动 ， 最 终 要 展览 的 结构 的 表 
面 都 暴露 到 分 析 师 面前 ， 它 有 很 高 的 体积 比 。 


18.8.4 纳米 机 器 人 设备 


设备 尺寸 的 缩小 使 得 许多 不 可 能 的 事情 成 为 可 
能 ， 如 使 用 纳米 大 小 的 工具 操作 纳米 大 小 的 物体 ， 测 
量 微克 范围 内 的 质量 ， 感 知 微 牛顿 范围 的 力 大 小 ， 并 
且 包 括 GHz 的 运动 ， 还 有 其 他 很 多 惊人 的 进步 。 
制造 业 上 的 例如 纳米 元 件 的 自 上 而 下 和 自 下 而 上 
的 策略 为 许多 研究 者 独立 研究 。 自 上 而 下 的 策略 ， 基 
于 纳米 制造 技术 ,并 且 还 用 到 了 其 他 一 些 技术 ， 如 上 毫 
微 光 刻 、 纳 米 压 印 和 化 学 腐蚀 。 目 前 ， 这 些 都 是 二 维 
制造 过 程 ， 并 且 分 辩 率 极 低 。 自 下 而 上 策略 是 基于 装 
配 技术 的 。 目 前 ， 这 些 策 略 包括 自 组 装 技术 、 芯 笔 光 
刻 和 定向 自 组 装 。 这 些 技术 可 以 产生 大 规模 的 规则 纳 
米 结 构 。 因 为 能 够 对 纳米 物体 进行 定位 和 定向 ， 纳 米 
操作 对 构建 、 描 述 和 装配 多 种 类 型 的 纳米 系统 是 一 种 
有 用 的 技术 。 通 过 与 自 下 而 上 和 自 上 而 下 的 过 程 相 结 
合 ， 基 于 纳米 机 器 人 操作 的 混合 型 纳米 机 器 人 操作 方 
法 可 以 提供 第 三 种 方法 来 制作 NEMS， 这 种 方法 通过 
构建 as- grown 纳米 材料 或 纳米 结构 来 实现 其 功能 。 
这 个 新 纳米 制造 技术 可 以 创建 带 有 构造 部 件 的 复杂 的 
3-D 纳米 设备 。 纳 米 材料 科学 、 生 物 纳米 技术 和 纳米 
电子 学 都 从 纳米 机 器 人 装配 技术 的 进步 中 获 益 良 多 。 

基于 独立 纳米 管 的 纳米 工具 ， 传 感 器 和 执行 器 配 
置 已 经 得 到 实验 证 明 。 如 图 18. 22 所 示 。 

具有 检测 表面 上 的 深 而 窗 的 特性 的 悬臂 式 纳米 管 
( 见 图 18. 22a， 参 见 参考 文献 [18. 191]) 的 特性 已 
经 作为 AFM, STM 和 其 他 类 型 的 SPM 上 的 一 个 探 针 
针尖 得 到 验证 [2 。 

碳 纳米 管 提供 了 超 小 的 直径 、 超 大 的 长 宽 比 和 优 
良 的 力学 性 能 。 手 工装 配 ， 并 直接 增长 '*Y! 是 构造 
它们 的 有 效 方法 。 悬 臂 式 纳米 管 可 以 作为 测量 超 小 型 
物理 量 的 探头 ， 如 微克 测 重 器 时 5 吕 ; 、piconewton FJ 
传感器 ， 以 及 在 静态 挠 度 基础 上 的 质量 流量 传 感 
380579). ， 或 者 改变 利用 电子 显微镜 观测 到 的 振动 频 
率 。 由 于 受 这 种 类 型 传感器 的 应 用 限制 ， 不 能 通过 显 
微 镜 实 时 测量 挠 度 。 极 间距 离 的 变化 导致 碳 纳米 管 发 
射 器 发 射电 流 的 变化 ， 可 以 作为 取代 显微镜 图 像 的 蔡 
代 品 。 单 个 碳 纳 米 管 桥接 '*“'"”  ( 见 图 18.22b) 是 以 
电气 特性 为 基础 的 。 开 口 的 纳米 管 到 2 ( 见 图 
18. 22c) 可 以 作为 原子 或 分 子 的 容器 、 温 度 计 呈 91， 
或 点 焊 机 中 。 静 电 偏转 纳米 管 已 被 用 来 构建 一 个 
Re ARS 。 可 以 利用 一 个 多 壁 碳 纳米 管 的 超 低 夹 
层 间 的 摩擦 创建 同一 系列 的 纳米 管 执行 器 。 参 考 文献 
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支柱 /阴极 = 


3) 


支柱 /阴极 支柱 /阴极 


100 nm 


图 18. 22 基于 纳米 管 的 单个 NEMS 配置 (RE: a) lpm (fA: l00nm b)200nm c)lpm d)100nm e)lpm 
f) pm g)20pm_ h)300nm 


a) 悬挂 式 b) 桥接 式 c) 开口 式 d) HÆR 


[18.195, 212] 提出 了 基于 伸缩 碳 纳米 管 的 直线 轴 
承 和 一 个 作为 旋转 轴承 的 微 驱动 器 ， 基 于 电泳 组 装 阵 
列 呈 2 成 批 生产 已 经 实现 。 与 纳米 机 器 人 操作 的 初 
步 实验 已 经 完成 ， 该 实验 是 在 有 前 途 的 碳 纳米 管 场 发 
射 当 前 服务 作为 位 置 反馈 的 直线 电 基 础 上 实现 
897579) ( 见 图 18.22d) 。 相 应 的 ， 通 过 手动 和 纳米 
机 器 人 的 装配 ， 甚 臂 式 双 纳 米 管 已 用 纳米 久 子 ?1 
FISK BG 7] 579! ( 见 图 18.22e) 做 成 。 根 据 不 同 温 
度 下 电阻 的 变化 ， 碳 纳米 管 热 探 针 能 够 测量 精确 位 置 
的 温度 ( 见 图 18. 22f) 。 这 些 热 探 测 需 比 基 于 碳 纳米 
管 的 温度 计 更 有 利 ， 因 为 后 者 需要 TEM 成 像 。 由 配 
置 表 明 ， 上 述 设备 的 集成 可 以 实现 ， 如 图 18.22g, h 
JOPAR ST) 。 单 个 碳 纳米 管 阵列 也 可 以 用 来 制造 纳米 
AERAR, WERL 751. SEP NEMS 的 碳 纳 米 
管 仍 然 是 一 个 丰富 的 研究 领域 ， 具 有 大 量 的 开放 性 
问题 。 新 材料 ， 如 纳米 线 、 纳 米 带 、 在 纳米 级 别 上 


e) 平行 式 f) 交叉 式 g) 垂直 阵列 h) 水 平 阵列 


的 聚合 物 ， 使 得 检测 和 驱使 超 小 量 或 者 具有 超 高 的 
精度 和 频率 的 物体 的 传感器 和 执行 器 成 为 可 能 。 通 
过 随机 蔓延 ， 直 接 增长 ， 光 学 锋 子 ， 纳 米 机 器 人 操 
作 ， 原 型 均 已 实现 。 然 而 ， 为 了 进行 NEMS 整合 ， 
自 组 装 过 程 中 会 变 得 越 来 越 重 要 ， 其 中 ， 对 于 大 规 
模 生 产 常规 的 2-D 结构 ， 我 们 认为 电泳 纳米 组 装 将 
起 到 很 大 作用 。 


18.9 结论 

尽管 许多 预言 家 声称 ， 如 Issac Asimov 的 在 人 体 
内 部 的 水 中 的 变形 杆菌 ， 以 及 Robert A. Freitas 的 纳 
米 医 学 机 器 人 ， 这 种 将 来 的 微米 /纳米 机 器 人 将 会 执 
行 的 任务 我 们 现在 并 不 清楚 。 然 而 ， 我 们 可 以 确定 的 
是 ， 智 能 传感器 、 制 劲 器 、 系 统 的 这 些 技术 正在 朝 着 
小 规模 发 展 。 这 将 会 成 为 将 来 制造 纳米 /纳米 机 器 人 
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的 工具 ， 同 时 也 会 成 为 可 能 开发 的 机 右 人 的 部 件 。 


压缩 这 些 硬件 的 大 小 


目前 是 非常 有 吸引 力 的 ， 例 如 


使 用 纳米 工具 来 操作 纳米 物体 ， 大 量 地 测量 毫克 微 
克 ， 对 于 微小 牛顿 的 敏感 力 ， 包 括 千 焰 的 运动 ， 其 
他 一 些 可 能 性 还 有 待 发 现 。 当 然 这 些 能 力 可 以 让 采 
用 微 / 纳 机 电 系 统 构造 的 未 来 微 /纳米 机 絮 人 来 执行 


任务 。 
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